AD-A279  934 

■iinnii 


(D 


NAVAL  POSTGRADUATE  SCHOOL 
Monterey,  California 


04* 

CDS 

tom 


THESIS 


DTIC 

SELECTE  1% 
JUN  07  Wl  I 


ACOUSTIC  POSmONING  OF  THE  NFS 
AUTONOMOUS  UNraSRWATER  VEHICLE  (AUV II) 
DUBINO  HOVER  CONDITIONS 


Kevin  A  TMrsidlo  'jffnc  quaitt?  TNSPECra® 


Mardb  1994 


TheMeAdvieor 


Antitony  J.  Healey 


dfqpvoved  fiir  p^itc  r^Me;  dyatcflmtaon  ie  unliauted 


94  6  6  041 


SBQJMirai^aainCATIONOPTHnPAOE 


FonaAnniMd 

REPORT  DOCUMENTATION  PAGE 

U  RDORT  ffiOAlTY  CLASSIFICATION 

UNCLASSIFIED 

lb  RESTRICTIVE  MARICINGS 

k.  SKUUTY  CLASSIFICATKW  AUTHOMTY 

}  DtSTRlBUnON  /AVAILABILITY  OF  REPORT 

Approved  for  public  release;  distribution  is  unlimited 

k  OBCLASSIFICATKWMXIVVNaRAraNG  SCHEDULE 

4  FOtFORMINO  OROANIZATION  REPORT  NULttER(S) 

i  MONITORINO  OROANIZATION  REPORT  NUMBERS) 

6i.NAkCOFFERFORMINOOROANIZATK»<  ft  OFFICE  SYMBOL 

(tfifplitftlO 

Naval  Postgraduate  School  34 

7a  NAME  OF  MONITORINO  OROANIZATION 

Naval  Postgraduate  School 

7b.  ADDRESS  (City.  State,  md  ZIP  Code) 

Monterey,  CA  93943-5000 

kNAMEOFFUNDRKVSPONSORING  ft  OFFICE  SYVfflOL 

OROANIZATION  (Ifwbcftte) 

9  PROCUREMENT  INSTRUMENT  IDENTTFICATIOH  NUKffiER 

Ic  ADDRESS  (C4y.  SMA  nd  ZIP  Code) 

10  SOURCE  OF  FUNDING  NUMBERS 

PROGRAM  PROJECT  TASK  WORK  UNIT 

ELEMENT  NO  NO  NO  ACCESSION  NO 

1 1  TITLE  (Include  Scewity  ClacsiIkaCton) 

ACOUSTIC  POSITIONING  OF  THE  NPS  AUTONOMOUS  UNDERWATER  VEHICLE  (AUV II) 
DURING  HOVER  CONDITIONS,  UNCLASSIFIED 

11  PERSONAL  AUTHOR(S) 

Kevin  A.  Torsiello 

Ik  TYPE  OF  REPORT  1»  TIME  COVERED  14  DATE  OF  REPORT  (Yeir.  Moiuh.  Diy)  IS  PACffi  COUNT 

Ei^dne^s  Thesis  from  3/93  to  3/94  1994  March  131 

16  SUPPLEMENTARY  NOTATION 

The  views  expressed  in  this  thesis  ai 
the  Department  of  Defense  or  the  U 

re  those  of  the  author  and  do  not  reflect  the  official  policy  or  position  of 
.S.  Government. 

IT  COSATI  CODES 

It.  SUBJECT  TERMS  (CoiMiue  on  icvcne  ifiicctiiiiy  aid  idcMify  by  block  number) 

Autonomous  Underwater  Vehicle,  Acoustic  Dynamic  Positioning, 
Marine  Vehicle  DynamirT,  Proportional  Derivative  Control 

FIELD  GROUP  SUB^OUP 

19.  ABSTRACT  (Continue  on  reverse  if  necessary  and  identify  by  block  number) 

The  ability  to  take  position,  in  a  dynamic  environment,  relative  to  a  local  stationary  object,  is  vital  to 
many  planned  missions  for  the  Naval  Postgraduate  School's  Autonomous  Underwater  Vehicle  (AUV  II) 
{H’oject,  such  as  bottom  surveying  and  mine  hunting.  The  AUV  II  can  achieve  this  ability  through  the  use  of 
its  sensors  along  with  stem  propul«on  motors  and  tunnel  thrusters. 

The  sensors  employed  by  the  AUV  n  include  a  free  directional  gyro  and  independent  self-sonar  which 
provide  acoustic  positioning  data  without  the  aid  of  a  transponder  net. 

Described  in  this  theris  are  the  details  of  the  internal  subsystems  of  the  AUV  II,  and  an  examination  of  its 
positioning  ability  through  the  aruUysis  of  maneuvering  experiments.  Commanded  motions  of  yaw,  lateral 
«id  longitudiiul  positioning  during  hover  conditions  are  studied. 

»  DiSTRlBUTION/AVAILABILITY  OF  ABSTRACT 

(^UNCLASSIFIEiyUNLlMITED  QsAMEASRPT  QdTICUSERS 

21  ABSTRACT  SECURITY  CLASSIFICATION 

Unclasrified 

22a  NAAft  OF  RESPONSIBLE  INDIVIDUAL 

Anthony  I.  Healey 

22b  TELEPHONE  (Include  Ana  Coda)  22c  OFFICE  SYMBOL 

408-656-3381  ME/HY 

H>Pml4T3,JUNM  Picvioyi  •«!)«>■<  ckuMc  SECURITY  CLASSfflCATlQN  OF  THIS  PAtffi 


S/N0102-LF-0I4-6603 


Unclassified 


I 


Approved  public  rdease;  distribution  is  unlimited 


ACOUSTIC  POSITIONING  OF  THE  NPS 
AUTONOMOUS  UNDERWATER  VEHICLE  (AUV II) 
DURING  HOVER  CONDITIONS 

by 

Kevin  A.  TorsieUo 
Lieutenant,  United  States  Navy 
B.  S.,  University  of  Connecticut,  1983 

Submitted  in  partial  fulfillment  of  the 
requirements  for  the  degrees  of 

MASTER  OF  SCIENCE  IN  MECHANICAL  ENGINEERING 

and 

MECHANICAL  ENGINEER 
firom  the 

NAVAL  POSTGRADUATE  SCHOOL 
March,  1994 


Author: 
Approved  by: 


l[evin  A.  TorsieUo 


Manhew  D.  Kelleher,  Chairman, 
Depavment  of  MecKluiieaL  Engineering 


Richard  S.  Elster 
Dean  of  Instruction 


ABSTRACT 


The  ability  to  take  position,  in  a  dynamic  environment,  relative  to  a  local 
stationary  object,  is  vital  to  many  planned  missions  for  the  Naval 
Postgraduate  Sdiod’s  Autonomous  Underwater  Vehicle  (AUV  ID  project,  such 
as  bottmn  surveying  and  mine  hunting.  The  AUV  II  can  achieve  this  ability 
through  the  use  of  its  sensm,  along  with  stem  propulsion  motors  and  tunnel 
thrusters. 

The  sensors  employed  by  the  AUV  II  include  a  free  directional  gyro  and 
independent  self-sonar  whidi  provide  acoustic  positioning  data  without  the  aid 
of  a  transponder  net 

Described  in  this  thesis  are  the  details  of  the  internal  subsystems  of  the 
AUV  II,  and  an  examinati<m  of  its  positioning  ability  throu^  the  analysis  of 
maneuvering  experiments.  Commanded  motions  of  yaw,  lateral  and 
longituifinal  positioning  during  hover  ccmditions  are  studied. 
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This  diapter  provides  a  diseoMion  of  the  badcground  information  and 
ontlinea  cf  the  sc(^  of  stiafy  for  this  theeifl. 

A.  BACKGBOUND 

The  apfdicatione  of  Remotely  Operated  Vehicles  (ROVs)  and  Autonomous 
Umkrwater  Vehicles  (AUVs)  are  sulgects  of  increasing  widespread  interest  by 
both  civilian  and  military  organizaticms. 

The  operation  of  ROVs  is  traditionally  accomplished  by  the  use  of  a 
phyacal  tether,  through  whidi  electrical  power,  ccmtrol  and  sensory  data  are 
transferred  between  the  vehicle  and  a  surface  ship.  An  ROV  therefore,  is 
under  the  continuous  control  of  a  human  operator  (pilot),  and  is  dependent  on 
and  tethered  to  the  host  fdatform. 

An  AUV  on  the  contrary,  operates  independently  of  any  physical  or 
electrical  tether,  and  requires  little  to  no  intervention  from  an  outside  activity. 
This  level  of  autonomous  operation  permits  a  greater  scope  of  mission 
capabilities,  and  as  such,  is  the  subject  of  numerous  research  projects 
encompassed  in  the  Autonomous  Underwater  Vehicle  project  at  the  Naval 
Postgraduate  School,  in  Montmey,  California,  at  the  M<mterey  Bay  Aquarium 
Research  Institute,  MIT  Sea  Grant,  Charles  Stark  Drake  Laboratories,  Woods 
Hole  Oceanographic  Institute,  Florida  Atlantic  University  and  the  Naval 
UndersMi  Warfiure  Center,  Newport,  Rhode  Island,  amongst  others. 
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Future  mieidons  planned  for  the  AUV  project  include  environmental 
surveying,  seardi  and  mine  hunting  missions.  Vital  to  the  accomplishment  of 
these  types  of  missions,  is  the  capability  for  the  vehicle  to  position  itself  in  the 
vicinity  of  a  stationary  otgsct  or  change  its  position  with  respect  to  an  object, 
within  a  dynamic  mvironment 

The  ability  to  accurately  maneuver  itself,  at  relatively  high  speeds,  within 
a  confined  enviromnent,  has  been  demonstrated  by  the  second  generation 
design  of  the  NFS  AUV  (AUV  II)  (Warner,  1991).  The  ability  to  achieve 
accurate  dynamic  positioning,  during  hover  conditions,  based  on  the  vehicle's 
own  acoustic  data  input,  has  been  made  possible,  only  recently,  through 
several  configuration  changes  to  the  AUV  II.  These  configuration  changes 
include  the  addition  of  a  high  frequency  profiling  self-sonar,  and  horizontal  and 
vertical  tunnel  thrusters. 

The  profiling  sonar  installed  in  the  AUV  II,  provides  acoustic 
environmental  and  positioning  data  without  the  use  of  external  signals  or 
transponder  networks.  The  performance  of  the  sonar  has  been  tested  and 
verified  by  previous  experimentation  (Ingold,  1991). 

The  design  and  performance  testing  of  the  tunnel  thrusters  have  been 
verified  and  documented  by  Good  (1989),  Cody  (1992)  and  Brown  (1993). 

B.  SCOPEOFIHESBS 

The  ofcgective  of  this  thesis  is  to  experimentally  examine  the  capability  of 
the  NFS  AUV  II  to  achieve  accurate  acoustic  positioning,  during  hover 
conditions.  It  is  the  contention  of  this  work  that  both  lateral  and  longitudinal 


position  of  the  vehide  can  be  maintained  using  hi^  firequency  onboard  sonar 
returns  without  the  use  of  a  transponder  net.  Furthermore,  that  without 
ocean  currmt  disturbances,  the  predsion  of  the  positioning  is  limited  only  by 
tlM  precision  of  the  sonar  and  the  threshold  of  operation  of  the  propulsors,  and 
stable  motion  is  achievable. 

Chapter  11  provides  documentation  of  the  mqjor  design  and  configuration 
changes  incmporated  into  the  AUV,  which  provide  the  capability  for  the 
vehide  to  accomfdish  the  hover  positicming  experiments. 

Chapter  III  indudes  a  description  of  the  test  fadlity,  laboratory  and 
equiianent  set-up  used  fia*  the  experiments.  The  procedures  for  the  positioning 
expoiments  are  also  discussed. 

The  results  of  the  positioning  experiments  are  provided  in  Chapter  IV, 
along  with  the  development  of  a  theoretical  model  and  its  comparison  to  the 
experimental  data. 

A  summary  of  condusions  and  recommendations  for  further  study  is 
discussed  in  Chiqiter  V. 
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JL  AUVnCONFIGUBATION 


Since  the  time  of  its  originel  deeign  (Good,  1989)  and  successful 
waterborne  denumstration  (Warner,  1991),  several  design  and  configuration 
concetto  have  been  the  subject  of  research  surrounding  the  AUV  project  at 
NFS,  resulting  in  numerous  published  theses.  The  result  thus  far  has  produced 
the  current  configuratian  of  the  AUV  II,  pictured  in  Figure  2.1. 

Tins  chapter  provides  a  descripti<m  of  the  migor  equipment  groups  which 
comprise  the  current  configuration  the  AUV  Fach  section  discusses  the 
nominal  operating  characteristics  and  ratings  as  applicable,  and  refers  to 
figures  within  the  text,  or  diagrams  and  the  wiring  list  vdiidi  are  induded  in  the 
appendices.  The  fdlowing  equiiAient  groups  are  discussed: 

1.  Sensors  (Environment  and  Vehicle). 

2.  GESPAC  M68020/30  Computer  System. 

3.  Prqailsion  and  Maneuvering  Equipment 

4.  Electrical  Power  Equipment 

A  sinqdified  blodt  diagram  of  these  major  equipment  groups  is  provided  in 
Appendix  A  This  diagram  shows  the  baric  eystem  power  paths  and  the 
computtt’  data  transfer  paths  between  the  components. 

The  wiring  list  for  the  AUV  U  is  provided  in  ^)pendix  B. 

Figure  2.2  shows  the  placemmit  of  the  mqjor  equipment  components  in 
the  AUV.  As  discussed  in  Good  (1M9),  the  propulsion  and  maneuvering 
equipment  (control  fins,  tunnel  thrusters  and  stem  propulsion  motors)  is 


Figure  2.1  AUV II 


amiifed  in  the  vdiide,  to  achieve  the  moot  efficient  maneuvering  c^pabilitiee. 
The  remainder  of  the  equipment  ie  loeated  to  achieve  the  moot  favorable 
volume  and  w«|^t  dietribution,  and  to  minimiie  the  length  of  the  wire  rune. 
The  batteriee  therefore,  are  centrally  located  in  order  to  keep  the  center  of 
gravity  doee  to  the  center  of  the  vehide  body.  'Hie  conqmter  ie  located  at  the 
center  of  the  vehide  body,  with  the  eerved  ecpiipment  located  ae  doee  ae 
poeeiUe  to  the  oomputm*. 

Calculatione  of  the  centere  of  gravity  and  buoyancy  are  provided  in 
.^n>endioee  C  and  D. 


A.  SENSORS 

The  eeneor  eyeteme  incorporated  into  the  AUV  II  provide  the  neceeeaxy 
input  data,  for  both  environment  conditione  and  vehicle  motion,  to  achieve 
autoKMmioue  vehide  operation  and  ccmtrd. 

1.  Environment  Seniors  (Semar  Eqaipmoit) 

The  eonar  euite  coneiete  of  three  typee  of  eonar  traneducere  with 
primary  fiinctione  being  horizontal  environmental  surveying  (prilling),  target 
imaging  (scanning)  and  bottom  surveying  (depth  measuring).  The  three  types 
of  semar  used  for  these  functions,  are  respectively;  the  Tritech  ST* 1000  and 
ST-725  semar  and  the  Datasonics  PSA-900  altimeter.  Placemmit  of  the 
transducers,  in  the  (flooded)  nosepiece  sectiem  of  the  AUV  is  shown  in  Figure 
2.3. 
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VIgiuw  S.8  Sensor  Location  (Noeqnece  Section) 
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a.  PrvfiUmg  Sow  (THitek  ST-1900) 

The  profi]«r  is  the  modftl  ST-1000  BOUBr,  manufactured  by 
Tritadi  Intematioiial,  Ltd.  Tliie  unit  it  a  con^iMt  cyttem,  operated  by  a  PC 
oon^Mitible  om^wter  and  it  integrated  with  the  Sr-726  tcanning  tonar. 

The  ST-1000  t<mar  head  operatet  at  a  firequency  of  1250 
kiloharta  (1000  kiloherti,  nominal),  with  a  <me  degree  conical  beam.  Itrequiret 
24  to  28  vdtt  (DC)  power  at  800  miKampt,  and  can  be  <q[)erated  at  deptht  up 
to  4900  feet,  over  ei^t  telectiUe  ranget  between  three  and  160  feet. 

The  ST- 1000  can  be  operated  in  two  modet;  Sector  Profiling  or 
Sector  Sonar  Scanning.  The  Profiling  mode  providet  360  d^ree  coverage, 
wlMte  the  delay  time  to  the  firet  edio  it  tented  and  returned  to  the  device 
terial  port  connector.  The  Scanning  mode  it  continuoua,  and  can  be  uted  for 
horiz<mtal  aector  acan,  or  for  vertical  left  or  ri|^t  tide  direction  coverage.  In 
thia  mode,  the  intenaity  of  the  returning  echoes  are  sensed  as  a  fimetion  of 
delay  time  and  returned  to  the  device  serial  port  connector  as  a  string  of 
values,  one  in  each  of  64  range  pixels.  At  larger  total  ranges,  lull  range  is 
divided  into  128  range  pixels.  For  the  shorter  ranges,  a  sonar  pixel  will  be  9.3 
centimeters  long  by  1-6  degrees  wide.  Intmiaities  are  scaled  firom  one  to  15, 
where  15  repreaente  the  UidK^it  strength. 

The  ST- 1000  tonar  head  it  mounted  vertically,  in  the  AUV, 
protruding  throui^  the  bottom  of  the  notepiece. 
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bk  Seatmimg  Samar  (TrUteh  ST-TiB) 

Tlw  icanning  aonar  ia  tha  ST-725,  alao  manufactured  fay  Tritech. 
It  oparataa  at  a  firaquan^  of  725  kilohota  with  a  ona  d^prea  by  24  dagrea  fan 
baam. 

Tha  ST-725  aonar  head  ia  mounted  aft  of  the  ST-1000,  but 
protruding  thrott^  the  top  of  the  noaepieoe. 

c.  Depth  Samar  (Dataaonict  PSA-900) 

The  depth  aonar  ia  the  Model  PSA-900  Sonar  Altimeter, 
manufactured  by  Dataaonica,  Inc.  It  ia  microprocaaaor  controlled. 

The  Dataaonica  operatea  at  a  frequent  of  210  kilohertz,  with  a 
ten  degree  conical  beam.  It  requirea  15  to  28  volts  (DC)  at  100  miliamps  and 
can  be  operated  at  depths  up  to  6500  feet,  at  ranges  up  to  90  feet. 

The  Datasonics  transducer  is  installed  as  described  in  Good 
(1989),  with  a  plastic  cone,  mounted  in  the  nosepiece.  Only  one  Datasonics 
transducer  is  used  here,  as  opposed  to  the  original  configuration,  and  it  is 
mounted  facing  downward,  aimed  throuch  the  bottmn  of  the  nosepiece. 

2.  Veliide  Senaora 

The  vdiide  aenaor  components  provide  the  input  data  for  the  position 
and  motion  of  the  AUV. 
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ThrM  typM  ci  gyn§  vert  need  to  measure  the  v^de's  angular 
peaitiea  and  roll,  pitdi  and  yaw  rates.  All  three  ^rpes  are  manufactured  hy 
Hunqdunqr,  Inc. 

(1)  Free  Qyro.  Tlie  fires  gyro  measures  the  yaw  ani^e  of  the 
vehide.  The  Model  PG23-7 102*1  is  a  two-degree*of*fireedom  unit  which 
refsrences  its  own  case  frame. 

Its  inner  and  outw  pmbals  have  360  degree  and  negative  to 
positive  85  degree  motion,  which  require  26  volts  (AC),  400  Hertz  input.  The 
pi^(^  is  an  outer  gimbal  syncro  contrd  transmitter  whidb  outputs  11.8  volts 
(AC).  The  gimbals  have  a  remote  cagingAmcaging  device  which  requires  28 
vdts  (DC)  input 

The  gyro  motor  requires  115  volts  (AC),  400  Hertz,  and 
spins  at  approadmately  24,000  revolutions  per  minute.  The  Model  PS27-0101- 
1  power  supidy  provides  the  400  Hertz  (26  and  115  volts  (AC))  input  to  the 
gyro. 

The  firee  gyro  is  located  aft  in  the  midbody  section  of  the 
AUV.  The  wiring  diagram  for  the  fifte  gyro  is  provided  in  Appendix  C. 

(2)  Vertioal  Oyro.  The  vertical  gyro  measures  the  pitch  and  rdl 
ani^M  of  tlw  vehide.  The  Modd  VG34*0301*2  is  a  two-degree-of-fireedom  unit 
with  both  axes  daved  to  local  gravity. 

It's  inner  and  outer  gimbals  have  360  degree  (roll)  and 
negative  to  positive  80  degree  (pitch)  motion.  The  pickoff  is  a  plastic 
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potantioaMtor,  wiiidi  au4Mto  negative  ten  to  poMtive  tan  volta  (IX?).  Required 
infrat  ia  28  volte  (DC). 


The  votical  gyro  ie  located  forward  in  the  midbody  section  of 
the  AUV.  Since  the  vehicle  body  ie  rigid,  gyro  placement  was  a  matter  of 
arrangemmit  rather  than  a  matter  of  required  locati<m  within  the  body. 

(3)  RateGyrot.  The  rate  gyros  measure  the  roll,  pitch  and  yaw 
rates  of  the  vehicle.  Each  component  of  the  Model  R(302-2324-l  has  sinid^ 
degree-of-fireedmn  motion  along  its  designated  axis,  and  is  torsion  spring 
mounted  to  produce  gimbal  disfdacements  proprational  to  angular  rate  iiqmts. 

Required  input  is  28  volts  (DC).  The  pickoffs  are  resistance 
P<rtentiomettfs  which  produce  output  voltages  of  negative  ten  to  positive  ten 
volts  (DC).  Maximum  rates  are  360,  90  and  90  degrees  per  second  for  roll, 
pitdi  and  yaw. 

The  rate  gyros  are  located  forward  in  the  midbody  section  of 

the  AUV. 

b,  DtpikCMCPSl-Tnmix) 

Vehicle  depth  is  measured  using  a  differential  pressure 
transducer  manufsetured  by  PSI-Tronix,  Inc. 

Ihe  FWC  series  (Sll-131)  is  a  strain  gage  based  transducer 
which  operates  from  zero  to  15  pounds  per  square  inch  (depth  to 
approximately  34  feet),  referenced  to  one  atmosphere.  It  requires  12  to  18 
voits  (DC)  supply  ami  ou^mts  zero  to  ten  volts  (DC). 
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The  probe  for  the  depth  cell  ie  located  in  the  noe^ece  section  oi 
the  rehide  in  the  aft  bulkhead,  in  order  to  permit  contact  with  the  water  at  the 
^dude's  depth,  with  minimal  flow. 

e.  V^hiete  Sm»or  (TurbthProbe) 

The  vehide  speed  through  the  water  is  measured  by  a  Turbo- 
Ph)be  turbine  flow  meter,  manufactured  1^  Flow  Tedmdogy,  Inc. 

The  transducer  is  an  axial  rdor  element,  mounted  at  the  end  of  a 
strut  The  strut  houses  an  electromagiMtic  pickoff  assembly  which  goMrates 
electrical  pulses  of  a  frequency  proportional  to  the  rotor  speed  and  flow 
velodty.  The  flow  meter  has  an  operating  range  of  one  tenth  to  six  feet  per 
second. 

The  flow  meter  is  used  in  coqiunction  with  the  LFA-307  Range 
Extending  Am|difiar,  also  manufactured  by  Flow  Technology.  This  amplifier  is 
used  fcr  signal  omditioiiing  to  insure  good  linearity  at  low  flow  velodties. 

The  flow  meter  is  mounted  in  the  nosepiece  section  of  the  AUV 
with  the  rotor  elemoat  inotruding  throu^  the  bottom  of  the  nosepiece. 

d.  Ifotor  RPM  Indicator  (HmtdcM-Paekard) 

Hewlett-Paduurd  Model  HEDS-5000  series  optical  encoders  are 
used  to  measure  motor  speed. 

These  encoders  are  configured  with  a  lensed  LED  source,  an 
intagratad  circuit  (IC)  with  datactors  and  output  circuitry,  and  a  code  wheel 
adiid&  rotates  batwaan  the  amittar  and  datectOT  IC.  Rotation  of  the  code  aheel 
ganaratas  a  pulsad  input  whidi  the  IC  circuitry  processes  to  produce  a  digital 


pubtd  ou^Hxt  RoUiitiimqMed  is  measured  in  terms  of  the  inilse  count  per  unit 
time,  or  the  time  width  of  successive  pulses.  The  encoders  require  a  8uiq>ly 
voltafe  of  one  half  to  seven  volts  (DC)  input  and  operate  up  to  30,000 
revohitMos  per  minute. 

Each  thruster  and  stem  propulsion  motor  is  configured  with  an 
encodm*  attached  to  its  shaft. 

B.  GESPACM680MVao  COMPUTER  SYSTEM 

The  fimction  isroviding  real  time  control  of  the  AUV II  is  accomplished 
through  the  use  the  GESPAC  M68020/30  smes  computer  system  and  various 
input/ou^ut  control  cards. 

The  OS-9  Operating  System  is  used  in  the  GESPAC.  It  provides  real 
time,  multi-tasldng  ciqiability.  C  language  is  the  source  code.  It  is  independent 
firom  the  input/output  devices. 

The  software  package  PC  Bridge  (trademark  of  GESPAC,  Inc.),  is  used  to 
communicate  between  the  GESPAC  and  an  external  IBM  PC  for  the  purposes 
file  transfer.  As  the  {processor  system  is  an  embedded  real  time  processor,  it 
operates  on  a  single  board  without  the  benefit  of  an  associated  hard  disc  for 
storage  of  memory  naxiules.  Only  operating  astern  modules  are  "burned"  into 
EPROM,  thus  run  modules  that  form  the  vehicle  control  functions  at  run  time 
must  be  loaded  firom  an  external  conqmter  into  the  embedded  inrocessor. 

The  mqjor  components  of  the  embedded  computer  system  are  positioned 
in  a  twelve  card  cage,  located  in  the  midbody  section  of  the  vehicle. 
Commuiucatimi  with  the  GESPAC  is  aco>mplished  throu^  an  118-232  serial 


oraimunications  port,  located  on  the  top  of  the  vehicle,  through  a  watertii^t 
ootmector  and  a  sufficiently  l<mg,  lightweight  watertight  cable. 

The  following  sections  give  a  brief  description  of  the  migor  components  of 
this  system.  The  paths  for  data  input/output  between  the  components  are 
dhown  in  the  blodi  diagram  of  ^>pendix  A. 

1.  GE8MPU-20  Micro  Processor  Unit 

The  GESMPU-20  module  uses  a  32  bit  68020  microprocessor  built 
into  a  single  board.  Ihe  microprocessor  uses  a  non-multiplexed  G96  bus  with 
32  bits  of  address  and  32  bits  of  data.  The  board  runs  at  25  megahertz  and 
has  an  associated  two  megabytes  of  CMOS  Dynamic  RAM,  on  an  adjacent 
card.  Its  power  requii^nent  is  positive  five  volts  (DC). 

The  GESMPU-20,  through  its  device  drivers  and  execution  level  real 
time  control  software,  compiled  into  executable  modules,  controls  all  computer 
fimctions  in  the  AUV. 

2.  GESMFI-l  Mnlti-Faiiction  IntmrfiBce 

The  GESMFI-1  is  a  universal  interface  module  with  two  RS-232 
serial  ports,  two,  eight-bit  parallel  ports  and  Uiree  16-bit  timers.  The  module 
runs  with  either  one  megahertz  or  two  nwgahertz  synclmmous  timing  and  has 
50  l^ytes  of  CMOS  RAM.  The  power  requirements  are  positive  five  and 
native  to  positive  12  volts  (DC). 

The  GESMFl-1  interfaces  with  the  14-bit  Synchro  to  Digital 
converter,  which  operates  on  the  data  from  the  firee  gyro.  The  MFI  card 


15 


provid—  tiM  iinb«ddad  processor  with  a  digital  data  value  of  zero  to  16384 
(2^^  eorre^ponding  to  one  revolution  (360  degrees)  of  the  yaw  angle  gyro. 

8.  GESSIO-IB  Serial  InpatAOntput 

TIm  GESSIO-IB  dual  interfisce  module  provides  two  RS-232  capable 
asyndironous  serial  ports.  The  power  requirements  are  positive  five  and 
native  to  positive  12  vdts  (DC). 

The  GESSIO-IB  provides  the  interface  for  the  ST-726  and  ST-1000 
sonar  transducers. 

4.  GESP1A-3A  Peripheral  brterfime  Adulter 

The  GESPIA-3A  has  two  parallel  16-bit  input/output  ports  and  four 
16-fait  timers.  The  power  requirement  is  positive  five  volts  (DC). 

This  module  provides  the  interface  for  the  firee  gyro  cageAmcage 
command  and  status  signals.  It  also  provides  an  input  for  the  Datasonics 
sonar  transducer,  the  CRYDOM  rela^  and  the  Calez  power  supplies.  It 
controls  the  Transistor-Transistor  Ix^c  (TTL)  which  provides  the  switching 
signals  for  the  relay/power  svq;>idy  system. 

5.  GE8ADA-lANDGESADA-2Aiialoc/l>igitalliiterf!Me8 

The  GESADA-1  and  GESADA-2  modules  provide  analog  to  digital 
(A/D)  and  digital  to  analog  (D/A)  functions.  The  Gj£SADA-1  module  has  a  16 
channel,  tmi-bit  A/D  input  section  and  a  four  channel,  ten-bit  D/A  output 
section.  The  GESADA-2  module  has  a  16  channel,  ten-bit  A/D  input  section. 
Both  modules  require  positive  five  and  native  to  positive  12  volts  (DC). 
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Th«  GESADA’l  module  interfaces  the  outputs  firom  the  Diacnostics 
module.  The  GBSADA-2  module  interfaces  the  ii^uts  from  the  vertical  and 
rate  gyros,  the  depth  cell  and  the  Datasonics  transducer. 

&  GESDAC-2B  Digital/Analof  Converter 

The  GESDAC-2B  module  futivides  an  8  diannel,  12>bit  D/A  output. 
Its  power  requirement  is  positive  five  volts  (DC). 

This  module  interfaces  the  inputs  to  the  propulsion  and  thruster 
motor  servo  anq>s. 

7.  GESHM-IA  Multiple  Timer  Modules 

The  GESTIM-IA  modules  provide  the  System  Timing  Control  (STC) 
functions.  Each  module  has  five,  16-bit  channels  and  a  real  time 
clock/calendar  functi<m.  The  power  requirement  is  positive  five  volts  (DC). 

Five  GESTIM-IA  timing  modules  are  used  in  the  AUV  which 
coordinate  the  ngnals  between  the  tachomet^  sources  (thruster  and  stem 
propulsion  motor  speed  indicators,  flow  mevar  and  control  surface  servo 
motors). 

C.  ITOPULSION/MANEUVEiaNG  EQUIPMENT 

The  inupulsicm  and  maneuvering  systems  are  comprised  of  three  groups  of 
equipmaat;  ccmtrd  surfaces,  stem  propulsion  and  thrusters. 


1.  Control  SarflMM 

Tho  dovoh^mmkt  the  design  the  control  euifeoee  is  presented  in 
Good  (1969).  The  shape  used  for  the  AUV  II  ai^lication  is  the  NACA  0016 
fialsectioiL 

Two  crudform  arrangements  of  control  surfaces  are  used;  one 
arrangement  fcsrward  and  one  aft,  on  the  midbody  section  of  the  AUV.  This 
arrangement  provides  highly  effident  maneuvering  capability  in  both  the 
hmrizontal  and  vertical  fdanes  as  evidenced  by  previous  waterborne  testing  of 
the  AUV  (Healey  and  Marco,  1992). 

The  control  surfaces  are  podtioned  through  the  use  of  radio  contrdled 
aircraft  servo  motors.  Airtronics  Model  94510  servos  are  installed,  one  for 
each  control  surface.  These  motors  have  a  maximum  torque  rating  of  110 
ounoes-inches  (6.875  pound-inches) ,  and  a  response  time  of  one  half  second  for 
a  zero  to  90  degree  movement. 

2.  SlemProimiaioii 

Tlie  AUV  II  is  configured  with  a  conventional  twin  screw  propulsion 
qrstem.  Detailed  development  of  the  design  is  provided  in  Good  (1989). 

A  conunerdally  purchased  running  gear  hardware  kit,  manufactured 
by  Gato/Balao,  Inc.,  is  installed.  The  kit  consists  of  two  brass  propellers, 
stainlew  sted  shafts  and  three  indi  brass  stuffing  tubes.  Two,  four  Made,  four 
indi  diameter  propdlers  are  installed,  each  capable  of  providing  approximately 
five  pounds  of  thrust  at  full  load  (Saiuxlers,  1990,  Coty,  1992). 
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Kectric  DC  servo  motOTi  are  uMd  for  the  Item  propulsion  units.  The 
PITMO  DC  Modal  14202  eoies  motor,  manufactured  by  Pittman,  Inc.,  has  a 
stall  torque  of  106  ounoe-indies,  a  no  load  speed  <d 3620  revolutiims  per  minute 
and  a  peak  power  draw  oi  333  Watts.  Operating  at  24  volts  (DC),  the  motor 
has  a  no  load  currmt  rating  of 0.230  anqw. 

The  AUV II  is  ccmfigured  with  four  tunnel  thrusters  whidi  provide  the 
capability  for  slow  speed  maneuvering,  hovering  and  station  keeping.  The 
thrusters  are  mounted  in  pairs,  one  mounted  horizontally,  one  vertically;  each 
pair  is  mounted  forward  and  aft,  in  the  midbody  section  of  the  AUV. 

Each  thruster  assembly  consisted  of  a  DC  servo  motor,  a  reduction 
gear  and  housing  assenibly,  a  pitq;)eller  assembly  and  thruster  tunnels. 

The  servo  motors  used  for  the  thrusters  are  the  same  as  those  used 
for  the  stem  propulsion  units  described  above;  PITMO  DC  Model  14202  series. 

The  reduction  gear  is  a  single  stage,  single  reduction  spur  gear 
configuration.  The  pinion  and  gear  are  made  ofDelrinCtrademaik  of  Winfired 
M.  Berg  Conq>any).  Both  the  pinion  and  gear  have  a  pitch  of  24  teeth  per  inch. 
The  i»nion  has  45  teeth  and  a  pitch  diameter  of  1.875  inches,  and  the  gear  has 
90  teeth  and  a  pitch  diameter  of  3.750  inches.  The  resulting  reduction  ratio 
provided  is  two  to  one.  The  gear  is  configured  as  a  ring  gear  and  is  fitted 
around  the  propeller  and  hub  assembly.  The  reduction  gears  are  assembled 
into  an  aluuunum  housing  to  which  the  thruster  servo  motors  are  mounted. 
(Cody,  1992) 
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The  pft^Mller  and  hub  aaatmMy  is  made  of  tu’ass.  The  propeller  is 
three  inches  in  diameter,  and  has  four  blades  mounted  at  45  degrees.  The 
Made  ani^e  is  constant  along  its  length,  and  the  blade  has  sero  camber  which 
pomits  equal  thrust  in  both  forward  and  reverse  directions  of  rotation.  The 
propeller  and  hub  assembly  is  mounted  on  a  stainless  steel  shaft  and  the 
thruatSoumal  bearings  are  made  of  Teflon.  (Cody,  1992) 

Aluminum  struts,  mounted  in  the  thruster  tunnels,  support  the 
fuopriler  shaft,  oriented  axially  in  the  thruster  housing.  The  tunnels  have  an 
inside  diameter  of  three  inches,  and  are  mounted  in  two  sections  on  either  side 
of  the  thruster  housings,  placing  the  thrustm*  housings  at  the  midpoints  of  the 
tunnels.  The  horixontal  tunnels  are  16.5  indies  and  the  vertical  tunnels  are 
ten  indies  in  length,  correqmnding  to  the  width  and  hei^t  of  the  AUV. 

The  modeling  and  performance  analysis  of  the  thruster  assemblies 
have  been  the  subject  of  several  theses,  induding  Good  (1989),  Cody  (1992)  nd 
&t)wn  (1993). 

D.  ELECTRICAL  POWER  EQUIPMENT 

The  objective  of  the  original  design  considerations  for  the  power 
requirements  of  the  AUV  II  was  to  provide  adequate  energy  onboard  which 
would  support  all  vehide  functions  for  at  least  an  hour  of  completely 
autonomous  operation.  The  installed  electrical  qrstem  provides  enoufi^  power 
to  run  the  vehicle's  onboard  computer,  sonar  and  electronics  systems  in 
addition  to  power  for  mobihty. 
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This  Mcti<m  dMcribtt  th«  ecmiponmito  of  tho  oloctrical  power 


qretem. 

L  14VoltBattieyPMks(PaBMoiile) 

Two  24  volt  (DC)  betteiy  pedu  provide  the  main  power  eouroe  for 
IfaeAUV.  Eadi  batteiy  pack  ie  made  iq>  of  two,  12  volt  (DC)  Panaeonic  Model 
LCL12V38P  rediarfeMile,  eealed  lead>aeid  batteriee  connected  in  smiee.  The 
batteries  wei|^  31.5  pounds,  and  have  nominal  capacities  of  34.0  amp>hours 
(ten  hour  rate)  and  38.0  amp-hours  (20  hour  rate). 

The  series  battery  padcs  provide  24  volts  (DC)  power  to  the  following 
equipmont 

1.  Rate  gyros. 

2.  Vertical  gyro. 

3.  400  HerUc  power  siqqily  for  the  free  gyro. 

4.  ACON  conqmter  power  supplies. 

5.  CRYDOM  relays. 

6.  CalsK  power  supplies. 

7.  Six,  PMW  servo  amplifiers  (thruster  and  ston  propulsion  motors). 

8.  Tachometer  sources  (thruster  and  stem  propulsion  motor  speed 
indicators,  Turboiirobe). 

The  battery  packs  are  located  in  the  midbody  section  of  the  AUV,  one 
fisTward  and  one  aft  oftheGESPAC  computer  cage. 

2.  ACONPWwwrSniiiilies 

Two  ACON  Model  R100T2405-12TS  inverter/power  supplies  are 
installed  to  provide  power  to  the  computer  eystems.  The  two  power  supplies 
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art  indapandMit  and  provida  poaitava  fivt  and  nagativa  to  poaitiva  12  volts 
0X3). 

Tha  powar  aiqqplias  ara  nanintad  in  tha  midbody  aaction  ^Mva  tlie 
fimvard  battaity  padi. 

S.  CalwrPnsaarSappiiaa 

Tha  Calax  Modals  12S15,  48S15  and  12S5  powar  supidiea  provide 
postiva  fiva  and  nagativa  to  positive  15  volts  0X3)  for  the  fdlowing  equipment 

1.  Referanoe  source  for  the  rate  gyros  and  vertical  gyro  (-fAlS  volts  (DC)). 

2.  Datasonics  sonar  (>f  15  volts  (DC)). 

3.  Dqith  cell  (>f  15  volts  (DC)). 

4.  GESTIM-IA  tinier  cards  (4-15  vdts  (DC)). 

5.  Centred  mirCsoe  servo  motors  (•*•5  vdts  (DC)). 

6.  CRYDOM  relays  (>5  volts  0X3)). 

The  power  supplies  are  mounted  in  the  midhody  section  above  the 
forward  battery  padi. 

4.  CRTDOM  Bailors 

The  CRYDOM  Modd  6300  relays  provide  the  voltage  switching  using 
TTL  logic  input  from  the  GESPIA-3A  modules.  Power  is  supplied  to  the 
following  coBsponenta: 

1.  Tritech  sonar  (ST-1000  and  ST-725)  (•f24volts  (DC)). 

2.  Caga/uneagevdtage  for  the  free  gyro  (ground  path). 


BmrvoAmpbiBmn  (Advancsd  Motion  C<»troto) 

Motor  4»6od  for  tho  tlmister  and  ttam  propulakm  motorB  is  controlled 
throu^  the  nee  of  Advanced  Motion  Gimtrols  PWM  Model  30AD8DD  servo 
anqpliilars.  One  amplifier  is  used  for  eadi  motor.  The  PWM  servo  amplifier 
uaea  a  saro  to  ten  voH  control  ngnal  to  modulate  the  pulse  width  of  a  24  vdt, 
five  to  45  Idldierts  (load  dependent)  ou^mt  signal  to  the  motor.  Direction  of 
the  motor  is  controlled  by  dianging  the  pcdarity  of  the  control  signal. 

The  servo  amfdifiers  are  located  in  the  midbody  section  of  tite  AUV, 
mounted  on  the  pmt  and  starboard  bulkheads. 

&  Sjyndhro  to  IMgItal  (8/D)  Cmivcrter 

The  Synchro  to  Digital  Convmter  is  a  14-bit  device  designed  at  the 
Naval  Postgraduate  School.  It  uses  an  Analog  Devices  card  which  converts 
the  phase  compmients  <^the  6ree  gyro  output  signal  to  digital  data. 

The  converter  is  located  in  the  midbody  section  and  is  mounted  on 
the  aft  Old  of  the  GESPAC  ocnnputer  card  cage.  The  wiring  diagram  for  the 
S^  convertet/Bnee  gyro  is  provided  in  Appendix  C. 

7.  Invortcr  (Motor  Inhibitor) 

A  signal  inverter  is  installed  between  the  GESPIA-3A  module  and  the 
servo  amps  to  prevent  energizing  the  thruster  or  stem  propulsion  motors 
during  computer  system  start-ups. 

The  invnter  is  located  in  the  midbody  section  and  is  mounted  above 
the  aft  battery  padc. 
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m.  BIPBRIMBNTALAPPABATUS  AND  PROCEDURE 


Ttaa  chapter  provid—  a  daacripti(m  c£  the  6qu4»neiit  and  prooedurea  used 
to  conduct  the  ho^rarpoaitioiMngaKperimentafcir  the  AUV II. 

Badcground  informati<m  ie  diaeueeed  concerning  the  preparation  of  the 
AUV  n  v^de,  the  ld>  and  eiqipcnt  fkcilitiee  and  the  test  equipment,  followed 
fay  an  outline  the  prooeduree  ueed  for  the  experiments  and  data  collection. 

A.  EQUIPMENT  PREPARATION 

The  equipment  used  for  the  hover  positioning  experiments  are  categorized 
into  three  groups;  the  AUV  II  vehide,  the  test  facility  and  the  programmed 
software  code. 

1.  AUVnVnhkle 

Ovmr  the  course  of  the  thirty  months  since  the  vehide  completed  its 
last  waterborne  tests,  numerous  configuration  changes  have  been 
incorporated  into  the  AUV,  the  results  of  vdiich  were  presented  in  Chapter  II. 
Many  man-hours  were  consumed,  involving  the  expertise  of  the  Medmnical 
Engineering  Department  madiine  ah<q}  personnel,  electronics  technidans, 
stalls ...  and  a  few  students. 

New  equipment  groups  installed  in  the  AUV  indude  sonar,  gyros, 
power  siqifd  es,  speed  sensors  and  computer  systems,  however,  the  equiimient 
adiich  provide  the  means  to  accomplish  the  ofagective  of  this  Ihens  are  the 
thrusters.  The  location  of  the  fatoiizontal  thrusters,  forward  and  aft  of  the 
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valiidt'i  oMitir  of  graivity  ponmt  rotation  and  Utml  tranalation,  while  the 


inhklo  hovirinf. 

Hie  final  deaign  conoept  tot  tiie  thruatero  waa  c<»n|deted  and  a 
prototype  aaa«nihly  waa  manofactured  and  aatiafhctorihr  teated  (Cody,  1992). 
The  Uuroe  remaining  thniater  aaaemhHea  were  then  conatnicted  and  the  four 
naita  inatatted  in  the  AUV. 

S.  Lab  and  Teat  Facility 

The  teat  fhdUty  for  the  AUV  progect  ia  located  in  building  290  the 
Naval  Poatgraduate  School  Annex.  The  facility  houaea  a  18,000  gallon 
ciqiadty  teat  tank  which  meaaurea  20  by  20  by  6  feet.  Other  e<iuipment 
include  a  filtration  and  recirculation  ayatem,  hoiat,  catwalk  and  external 
computera. 

The  extonal  computers  include  an  IBM  PC  done  486  with  a  VGA 
grajdiica  monitor,  a  done  286  PC  and  the  GESPAC  Development  System, 
itdiich  is  a  refdicataon  of  the  in>vehide  ^stmn  with  a  hard  drive,  C  code  cross- 
compiler  and  PC  Bridge  software  fw  transferring  oonqnled  modules  of  code  to 
and  fimn  the  vehide. 

In  preparation  for  the  hovering  experiments  the  interior  of  the  tank 
was  painted  with  white  epoo^,  and  a  2.6  foot  square  grid  pattom  was  laid  out 
akmg  the  bottom  and  si<foa  of  the  tank.  Thio  permitted  good  visibility  of  the 
vddde,  mad  provided  a  reference  for  vehicle  pre-positioning  and  motion 
dbaarvataoB,  daring  teating.  A  catwalk  was  iiwtalled  across  the  t<q>  of  the  tank 
for  vdiicie  lanndi  and  recovaty,  and  esperiment  obaervatHm. 
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9»  Goiytif  SulliiMPB 

In  wdnr  to  tupport  the  basic  operatinf  functions  of  the  AUV  in 
addition  to  executing  the  positioning  experiments,  numerous  software 
programs  were  wriUen  and  installed  in  the  onboard  GESPAC  and  external 
cmitrol  computer  qrstems.  The  development  of  the  software  programs  is  the 
stdgeet  of  a  doctoral  dissotation,  currently  in  progress  by  David  B.  Marco. 

Some  oi  the  AUV  operations  supported  by  the  software  include  the 


1.  AUV  system  start-up. 

2.  Free  gyro  caging^incaging. 

3.  Gyro  zeroing  functkms. 

4.  Sonar  (q)eratioas. 

5.  Sensor  data  input  functions  (A/D). 

6.  Ccmunand  positions  fm*  moti<m  experiments. 

7.  Control  law  functions  for  eadi  (grating  mode  of  behavior. 

8.  Command  data  ou^Mit  functions  (D/A). 

9.  Data  storage  for  analyses. 

It  should  be  noted  that  independent  software  modules  for  debugging 
subsystem  (^rations  are  not  only  desirable,  but  essential  to  the  calibration 
and  verificaticm  of  vehicle  functions. 

B.  EZPEBIMENTAL  APPARATUS 

The  equipment  arrangement  for  the  hovering  motion  experiments  is 
shown  bn  Figure  3.1. 
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Test  Tank  (20' z  20’ X  6  ) 


flgara  S.1  Experimental  Set>up 
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For  th«  inirpoMt  of  conducting  these  experiments,  an  electronic  tether 
was  attadied  to  the  onboard  GESPAC  computer  via  the  RS'232  connection. 
Hus  provided  a  direct  path  for  file  and  data  exchange  between  the  GESPAC 
coBDgNiter  and  the  extunal  PC  workstation  running  PC  Bridge  software. 

The  vehicle  is  lifted  into  the  test  tank  via  the  hoist,  and  positioned  for  the 
start  of  each  oqieriment  by  observers  on  the  catwalk.  The  observers  remain 
stationed  on  the  catwalk  throu^u>ut  the  tests  to  recover  the  vehicle  or  prevent 
damage  should  an  equipment  casualty  occur. 

The  vehide  is  operated  externally  through  the  PC  workstation,  however 
the  serial  link  is  used  only  for  file  and  data  transfer.  Motion  commands  are 
built  into  the  run  program  through  screen  entry,  but  once  entered,  the  vehicle 
is  completely  independent  of  any  further  commands  for  the  operation.  Data 
files  recmded  for  each  experiment  are  down-loaded  to  the  PC  workstation. 

The  AUV II  vehicle,  test  tank  and  PC  workstation  are  pictured  in  Figures 
3.2  and  3.3. 
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Figure  3.2  AUV  II  and  Test  Tank 


I 
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Figure  3.3  AUV  II  and  PC  Workstation 
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C.  BIPBRIMENTAL  PROCEDURE 


TIuf  Motion  daocribet  the  inrooeduree  used  to  calibrate  the  test  equipment 
and  outliuM  the  three  typea  (d' hover  positioning  experiments,  including  data 
odlection. 

1.  Rate  Gyro  CaUbnitkMi 

Calibration  of  the  rate  gyro  was  required  due  to  a  new  pow^  supply 
being  used  for  its  input.  The  new  power  supply  also  produced  a  change  in  the 
range  of  ou^ut  voltages  firom  the  gyro. 

It  was  anticipated  that  both  a  scale  factor  and  a  bias  error  would  be 
electronically  introduced  into  the  gyro  ou^jut 

An  additional  bias  error  was  expected  as  a  result  of  the  zeroing 
procedure  to  be  used  at  the  start  of  the  experiments.  During  this  procedure, 
the  vehicle  is  held  as  motionless  as  possible  in  the  tank.  As  the  experiment 
starts,  before  any  control  motion  begins,  a  segment  of  the  run  code  reads  the 
sensors,  taking  initial  position  readings  of  the  vehicle  relative  to  the 
environment  Average  values  of  positions  and  rates  are  calculated  and  used  as 
zero  pmnts  for  the  following  test  rate  and  position  measurements.  Unless  the 
vehicle  is  perfectly  motionless  (which  is  impossible  in  this  test  facility)*  there 
will  be  some  rate  bias  introduced,  however  it  was  expected  that  this  would  be 
small. 

Referencing  the  righthand  i^obal  and  body  fixed  coordinate  systems, 
as  idiown  in  Figure  3.4,  the  scale  factor  (SF)  and  bias  factor  (BF)  errors  are 
modeled  by  the  fidlowing  equation; 
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Flginrt  S.4  Ri^it-Haiid  Global  and  Body  Fiiiad 

Coordinate  Byatama 


iiribare  it  was  conadwed  that  the  predeion  of  the  heading  gyro  (drift  rate  leee 
than  eoc  degreee  per  hour)  wae  euA  that 

The  eKperimental  yaw  rate  can  then  be  corrected  by  the  following  equation: 

fte-  SF + BF 

The  true  yaw  rate  could  then  be  found  by  correlating  the  experimental  yaw 
rate  data  to  the  derivative  of  the  yaw  position  data  using  a  first  order  least 
squares  fit 

Since  the  vehicle,  when  fdaced  in  the  tank,  essentially  behaved  as  an 
ideal  rate  table,  it  was  decided  to  use  the  vehicle's  own  motion  under  a  yaw 
position  command  to  calibrate  the  rate  gyro.  This  motion  is  shown  m  Figure 
3.5.  Inputs  firom  the  free  gyro  were  used  to  determine  the  vehicle’s  yaw 
positian. 

The  control  laws  for  the  yaw  positicm  commands  were  derived  on  the 
basis  that  the  commanded  moment  is  directly  proportional  to  the  differential 
thrust  between  the  forward  and  aft  lateral  thrusters,  where  the  thrusters  are 
used  in  opposite  directions.  Additionally,  the  thruster  force  is  proportional  to 
tiie  square  ci  the  sqndied  motor  vcdtage  (using  the  absolute  value  to  account  for 
directioi^. 


figure  8^  Yaw  Rate  Calibrati(ni/yaw  Poaitioniiig  Experiment 


Ftw--V^|V^| 

Howvwr,  in  order  to  koq>  the  control  effort  linoor»  the  poeition  commando  were 
generated  going  prcquortiogal  derivative  contnd  lawe  for  the  thrueter  vedtages. 
Baaed  on  the  eqaatione  ihove,  the  control  lawe  far  the  forward  and  aft  thrueter 
voltagee  are  ae  follows: 

Vr.4tw  =  ~K,(4'-4'^)-K,(r-r_) 
=K,(H'-'F^)+K,(r-r^) 

K,-K,xT,, 

The  control  law  gains  were  selected  heuristically,  estimating  that  a 
lull  voltage  ccmtrol  effort  (24  volts)  would  be  used  for  a  yaw  position  error  of  tc/8 
(22.6  degrees),  with  a  nominal  time  constant  of  one  second.  These  estimates 
resulted  in  the  following  control  law  gains  for  yaw  positioning; 

K,*60 

The  position  conunands  were  given  for  yaw  angles  of  (negative)  30, 
60, 90, 180  and  360  degrees  (rdative  to  a  starting  positian).  Three  trials  were 
conyteted  for  each  commanded  positkm  am^e. 

The  data  recorded  included  yaw  position,  yaw  rate  and  forward  and  aft 
thruster  vedtage  ininits  as  functions  of  time.  Figure  3.6  presents  the  yaw 
position  versus  time  and  the  yaw  rate  versus  time  curves  for  the  three,  180 
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dtfrMtMli.  (Note  that  IIm  yaw  rate  curve  ii  unoorreetad.)  It  ia  ahown  in  this 
figure  that  good  repeatalality  waa  adiievod. 

A  firat  order,  laaat  aquaraa  fit  waa  uaad  to  obtain  the  acale  factor  ai^ 
biae  fhetor  between  the  meaaured  yaw  rate  data  and  the  duivative  of  the  yaw 
poaitioii  data.  Parting  with  the  firet  30  d^ree  teat,  a  acale  factor  of  3.2709, 
and  a  biae  tector  of  0.0043  were  obtained.  Figure  3.7  preaenta  theae  reaulta. 
ThiB  figure  ahowa  that  an  accurate  fit  vraa  ol^ained. 

For  compariaon,  the  meaaured  yaw  poaition  data  waa  compared  to 
the  integral  of  the  corrected  yaw  rate  data.  Theae  reaulta  are  alao  preaented  in 
Figure  3.7.  Faiiiy  good  agreement  waa  achieved. 

Uaing  the  aame  procedure,  the  acale  and  biaa  factors  were  obtained 
for  the  remaining  testa.  The  results  are  presented  in  Table  3.1.  From  the 
results,  it  waa  observed  that  the  acale  factor  varied  slightly,  however  a 
nominal  value  of  3.(X)  would  not  produce  a  great  error  in  any  of  the  teats.  'Die 
vaiiatam  in  the  bias  was  email  and  appeared  to  be  random. 

Based  on  these  results,  it  was  felt  that  the  yaw  position  data  was 
more  reliable  and  all  subsequent  yaw  rate  data  would  be  corrected  using  the 
same  procedure. 

2.  Ynw  Portioning  Eaperiaaent 

As  discuaaed  in  the  previous  section,  the  yaw  positioning  experiment 
was  used  fiir  the  rate  gyro  calilxation. 

Inputs  firom  the  fires  gyro  were  used  to  determine  the  vehicle's  yaw 
positicm.  The  position  commands  were  given  for  yaw  angles  of  (negative)  30, 
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TMMtMM,!  YAW  RATE  CALIBRATION:  SCALE  AND  BIAS  FACTORS 


TItT 

TBXAI. 

SCALE 

FACTOE 

(SF) 

BIAS 

FACTOE 

(IF) 

30  0B6IIIB 

1 

3.2709 

0.0043 

2 

3.2960 

0.0055 

3 

3.2662 

0.0017 

60  DBOBBB 

1 

3.0059 

0.0013 

2 

3.0257 

-0.0011 

3 

3.0209 

0.0025 

90  OBGBBB 

1 

2.9529 

0.0004 

2 

2.9699 

-0.0034 

3 

2.9375 

0.0010 

160  OBOllBB 

1 

2.6387 

0.0031 

2 

2.6592 

0.0006 

3 

2.6799 

0.0010 

360  DE6BBE 

1 

2.6208 

0.0015 

2 

2.8727 

0.0004 

3 

2.6470 

0.0046 
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60, 90, 180  and  360  degraat,  uainc  a  pn^mtiooal  derivative  control  law.  The 
data  obtained  for  the  caKbratkm  teete  was  used  to  analyze  the  yaw  poeitiomng 
e^i^nlity  of  the  AUV. 


The  motion  for  the  lateral  poeiti<minf  experiment  is  shown  in  Figure 
3.8.  In  additi<m  to  inputs  from  the  free  gyro,  inputs  from  the  i»ofiling  sonar 
were  used  to  determine  the  vehicle's  lateral  positicm  with  respect  to  the  tank 
waD. 


The  control  laws  for  the  lateral  positioning  commands  incorporated 
the  combined  behavior  modes  of  yaw  and  lateral  motion.  For  the  yaw  motion, 
the  control  effort  is  generated  in  the  same  way  as  discussed  for  the  yaw 
positiiniing  experiment  For  the  lateral  motion  however,  the  forward  and  aft 
lateral  thrusters  are  used  in  the  same  direction. 

nrat  (L«t)  ^  (Lrt) 


Therefore,  for  a  linear  control  effort,  accounting  for  both  behavior  modes,  the 
lateral  position  commands  for  the  thruster  voltages  are  given  using  the 
following  proportiCTial  derivative  control  laws: 

V«»..-KT{'l'-'i'_)+K,(r-r_)-K,(y-y_)-K.(Y-Y„) 

K,.K,xT„ 

K..K,xT„ 
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Tftbl«  3.2  lists  the  test  conditions  for  the  lateral  positioning 
sapsrimsnt,  The  control  law  gains  were  varied  in  order  to  examine  the  coiq)ling 
^eets  between  the  lateral  and  yaw  motions.  The  effects  of  changes  in  the 
range  of  motion  were  examined  fay  varying  the  initial  and  commanded  positiona 
to  cover  small  and  large  changes  in  position.  A  commanded  yaw  position  of 
xero  degrees  was  given  for  all  testa. 

Data  c(dlected  included  range  (global  Y  direction)  to  the  wall,  sway 
velocity,  yaw  position,  yaw  rate,  and  forward  and  aft  thruster  voltage  as 
functions  time. 

The  sway  velocity  data  was  obtained  by  extracting  an  estimate  of  the 
derivative  of  the  lateral  range  data  from  the  sonar,  using  a  Kalman  filter 
subprogram.  The  smooth  velocity  estimate  was  used  for  the  velocity  error 
feedback.  The  filter  also  provided  a  smooth  position  estimate  which  was  used 
for  the  position  error  feedback.  The  subprogram  for  the  Kalman  filter,  in  C 
source  code,  is  jawide  in  Appendix  F. 

4.  Longitudinal  Positioning  Eiqmriinent 

The  motion  for  the  longitudinal  positioning  experiment  is  shown  in 
Figure  3.9.  In  addition  to  inputs  firom  the  firee  gyro,  inputs  firom  the  profiling 
sonar  were  used  to  determine  the  vehide's  position  with  respect  to  the  tank 
wall,  ahead. 

The  control  laws  for  the  longitudinal  positioning  commands  account 
tor  the  behavior  modes  of  yaw  and  longitudinal  motion,  however  these  modes 
are  oontrdled  eeparatdy  throu^  use  of  the  thrusters  and  the  stmn  propulsicm 


TABLE  8J  LATERAL  AND  LONGITUDINAL  POSITIONING 

EXPERIMENTS:  TEST  CONDITIONS 


LATERAL  POSITIONING  EXPERIMENT:  TEST  CONDITIONS 


TEST 

Ky 

Tdy 

Rpsi 

Tdptl 

Ylnlt 

Yeoa 

PSlcoa 

1 

7 

2 

60 

1 

5.0 

3.5 

0.0 

2 

10 

3 

80 

1 

9.4 

4.0 

0.0 

3 

12 

3 

80 

1 

9.0 

4.0 

0.0 

4 

12 

3 

60 

1 

9.0 

3.0 

0.0 

5 

10 

3 

80 

1 

16.0 

4.0 

0.0 

LONGITUDINAL  POSITIONING  EXPERIMENT:  TEST  CONDITIONS 

TEST 

SONAR 

GAIN 

Kx 

Tdx 

Kpsi 

Tdpsi 

Xinit 

XCOB 

PS I con 

1 

13 

10 

3 

60 

1 

12.0 

7.5 

0.0 

2 

13 

10 

3 

60 

1 

12.0 

5.0 

0.0 

3 

9 

10 

3 

60 

1 

12.0 

5.0 

0.0 

4 

5 

10 

3 

60 

1 

12.0 

5.0 

0.0 

5 

5 

10 

3 

60 

1 

11.6 

5.0 

0.0 

6 

5 

10 

4 

60 

1 

7.0 

2.5 

0.0 

7 

5 

10 

4 

60 

1 

12.0 

3.0 

0.0 
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aolora.  Similar  to  the  thruatera  fw  Uteral  motioii,  the  atem  propulaion 
OMhara  are  uaed  in  the  aame  direetioa. 

ThMrefcne,  a  linear  control  effort  ia  achieved,  by  generating  the  longitudinal 
poaition  cwnmanda  uaing  the  following  proportional  derivative  control  law  for 
the  atem  propulaicai  motor  voltagea: 

»K,(X-X«)+K.(X.X^) 

K,  sKxxT,, 

In  addition,  aa  for  the  yaw  positioning  experiment,  position  commands  for 
thruster  voltages  were  givm  using  the  fdlowing  contrd  laws: 

-  K,(<l'->l'„)+IC,(r-r„) 

K,  =  K,xT„ 

Table  3.2  lists  the  test  conditions  for  the  longitudinal  positioning 
eaperiment  TIm  sonar  gains  were  varied  in  order  to  examine  the  effects  on  the 
stalnlity  the  position  data.  The  sonar  gains  shown  are  equivalent  to  the 
percmtages  of  the  total  transmission  power  of  the  transducer.  The  thruster 
vdtage  control  law  gains  fOT  yaw  position  were  set  at  60  and  one  (proportional 
and  derivative,  respectively),  and  a  commanded  position  of  zero  degrees  was 
given. 

The  lateral  and  yaw  motion  coiqding  effects  were  examined  along  with 
the  cdfocts  of  changes  in  the  range  of  motion. 
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Data  coll«etod  indudtd  rug*  (global  X  directioii)  to  the  wall,  surge 
vdodty,  yaw  poaitiaii,  yaw  rate,  and  f<»ward  and  aft  thruster,  as  wdl  as  stem 
propulston  motor  vdtages  as  functions  of  time. 

The  surge  velocity  data  was  obtained,  similarly  to  the  lateral 
positk»ing  experiment,  throu^  the  use  of  the  Kalman  filter  subprogram. 


IV.  EXPERIMENTAL  RESULTS 


The  iNupoM  of  thii  chapter  ie  to  document  trends  in  the  eiq>«rimental 
data  collected  f(v  the  AUV  positi<ming  experiments.  Each  type  of  moticm 
studied  (yaw,  lateral  and  longitudinal),  is  addressed  separately,  and  specific 
obeenrations  are  made  with  respect  to  the  dynamics  of  the  motion,  ability  to 
achieve  the  commanded  final  position,  commanded  thruster  and  stem 
fot^Milsion  vdtages  and  where  apjdicable,  the  effects  of  changes  in  control  law 
gauM,  sonar  gains  and  the  range  of  motion. 

The  results  of  the  positioning  experiments  are  then  compared  to  a 
theoretical  modd. 

A.  TAW  POSITIONING  EXPERIMENT 

As  described  in  Chiqita’  III,  yaw  positiiniing  e9q)eriments  were  used  for  the 
rate  gjnro  calibration.  Inputs  firom  the  fiee  gyro  were  used  to  determine  the 
vehicle's  yaw  position.  Position  commands  were  given  using  proportional 
derivative  contrd  laws,  for  thruster  voltages.  The  position  commands  were 
given  fen*  yaw  anises  of  (negative)  30, 60, 90, 180  and  360  degrees  (relative  to  a 
starting  position). 

Tlw  data  detained  for  the  calibration  tests  was  used  to  analyze  the  yaw 
poaituming  capdnHty  of  the  AUV.  The  data  recorded  included  yaw  position, 
yaw  rate  and  forward  and  aft  thruster  vdtage  inputs  as  functions  of  time. 


Figure  4.1  shows  the  yew  positioii,  yew  rete  end  thrusts  volteges  for  the 
90  degree  test  The  yew  position  curve  shows  the  motion  response  expected 
firom  e  pnqimrtaonel  derivetive  control  lew.  During  the  initiel  stege  of  motion, 
the  vehide  did  not  quite  reech  e  constant  turning  rate  as  seen  fay  an  inflection 
point  at  approximately  six  seconds.  With  a  steady  state  error  band  of 
iqq^roximately  seven  degrees,  a  sin^e  overshoot  is  observed  due  to  inertial 
fiurces  initially  dominating  the  motion.  Drag  forces,  proportimial  to  the  square 
of  the  yaw  rate  then  became  dominant,  and  the  motion  of  the  vehicle  was 
heavily  damped  to  an  accurate  steady  state  position. 

The  yaw  rate  curve  shows  connstent  results  with  peak  turning  rates 
occuning  at  annroximatdy  six  and  13.5  seconds. 

The  thruster  voltage  curve  shows  the  forward  and  aft  thrusters  were 
employed  in  equal  and  opposite  directions.  Also  note  that  saturation  had 
occurred  until  a^Mroximately  six  seconds,  which  as  previously  mentioned,  was 
not  long  enoud*  to  reach  a  constant  turning  rate. 

The  effects  of  the  magnitude  of  the  commanded  turn  are  shown  in  Figure 
4.2.  The  yaw  position  curves  show  that  the  vehicle  bad  readied  a  constant, 
peak  turning  rate  at  approximately  seven  seconds,  for  the  180  and  360  degree 
tests.  Consistent  dynamic  results  are  shown  with  single  overshoots  followed 
fay  heavily  danqied  a^voadies  to  accurate  steady  state  positions. 

The  yaw  rate  curves  show  the  constant  turning  rates  for  the  180  and  360 
d^ree  tests.  The  differences  in  the  values  of  the  rates  is  due  to  experimental 
repeatability.  The  average  peak  turning  rate  was  observed  to  be 
qiproiximatdy  16.0  di^rees  per  second. 
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Flgore  4.1  Yaw  PodtkMi  Experiment:  90  Degree  Test 
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Wlul«  tlM  trror  i«  wnalf,  the  final  aiUmiy  state  yaw  position  was  not  exact 
in  all  cases.  As  discussed  in  Co(fy  (1992)»  a  small  voltage  threshold  exists  fcnr 
the  thnnter  motors,  due  to  medianical  fr' cticn  in  the  motor  and  reducticm  gear 
houaing  (stiction),  which  prevents  very  small  correctiona  in  position.  This 
condition ,  to  varying  extents  exists  in  all  of  the  thruster  assemblies  as  well  as 
the  stem  propulsion  assemMies. 

The  thruster  vcdtage  curves  show  the  different  time  periods  of  saturation 
for  the  three  tests.  The  differences  in  Uie  peak  voltages  are  due  to  the 
differences  in  the  combined  effects  of  the  position  error  and  the  turning  rate 
firom  which  the  proportional  derivative  control  law  determines  the  control 
effort.  As  previously  mentioned,  the  final  steady  state  voltage  was  not  always 
zero  volts  due  to  thruster  stiction. 

The  vehicle's  ability  to  recover  a  commanded  position,  given  a  disturbance 
is  shown  in  Figure  4.3.  Once  the  vehicle  reached  the  commanded  position,  it 
was  given  two  manual  disturbances  in  the  direction  of  the  overshoot.  In  both 
cases,  the  commanded  position  was  quickly  recovered.  The  thruster  curve 
shows  that  saturation  occurred  for  both  recovery  efforts. 


flgai*  4J  Yaw  Pontum  EiqMuriiiieQt:  960  Degree  Test,  with  Disturbanoes 


B.  lATBBALPOSmONlNGEXPBBIMENT 

TIm  furocedurt  for  the  lateral  petitioning  experiment  was  described  in 
Chapter  III.  Inputs  from  the  free  gyro  and  the  pndiling  sonar  were  used  to 
determine  the  vehide's  lateral  position  with  respect  to  the  tank  wall.  Positi(Hi 
commands  for  the  thruster  voltages  were  given  using  intuitional  derivative 
control  laws. 

The  test  conditions  for  the  lateral  positioning  experiment  are  shown  in 
Table  3.2.  Tlw  data  cdlected  included  range  (i^obal  Y  direction)  to  the  wall, 
sway  velocity,  yaw  position,  yaw  rate,  and  forward  and  aft  thruster  voltage  as 
functions  of  time. 

Figure  4.4  shows  the  results  for  Test  1.  Hie  range  curve  shows  a  single 
overshoot  approach  to  an  accurate  steady  state  commanded  position  for  a 
modest  positioning  command  as  expected  for  the  proportional  derivative 
control.  Consistent  with  the  results  fnr  the  yaw  positioning  experiment,  error 
in  the  final  steady  state  position  achieved  is  due  to  thruster  stiction.  A 
noticeable  amount  of  noise  is  present  in  the  range  signal  and  is  emphasized  in 
the  velocity  curve. 

The  yaw  position  curve  shows  very  small  deviations  frum  the  commanded 
zero  degree  position.  For  clarity,  the  negative  value  of  the  forward  thruster 
voltage  was  plotted  for  the  thruster  voltage  curve.  Neither  thruster  reached 
saturation  for  this  small  range  of  motion,  however  the  relative  dominance  of 
the  yaw  position  errenr  to  the  control  effort  can  be  seen  in  the  difference 
between  the  vditage  curves.  This  difference  is  diown  in  Figure  4.5,  where  the 
yaw  positum  curve  is  also  plotted  for  comparison. 
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Fvr  TMt  2,  •  fraatar  range  oi  motion  was  commanded,  and  the  oontnd  law 
gaina  were  increased.  The  yaw  position  curve  of  Figure  4.6  shows  the 
duuractwistic  approadi  to  the  ccanmanded  position  with  slightly  less  noise, 
until  70  seconds  whore  the  sonar  return  went  unstable.  This  instability  at 
dose  range,  was  attributed  to  a  bi|^  sonar  gain.  The  effects  of  reducing  the 
sonar  gains  were  earamined  during  the  longitudinal  positiooingespwriinent 

With  the  increased  control  law  gains,  coupling  the  two  motion  ccmtrol 
modes  of  yaw  and  sway  was  emidiaaized,  as  shown  by  the  yaw  position  curve. 
Proportional  derivative  control  does  not  compensate  for  this  effect,  and  the 
result  was  a  disturbance  effect  created  by  oae  mode  working  against  the  other. 

The  thruster  voltage  curve  shows  that  both  thrusters  reached  saturation. 
The  aft  thruster  was  reduced  sooner  due  to  the  decrease  in  yaw  positian  caused 
by  the  smaller  horizontal  cross-section  area  oi  the  vebide's  stem. 

Further  increase  of  the  lateral  position  control  law  gains  showed  little 
reduction  in  the  resp<mse  time  to  achieve  the  commanded  position  in  Test  3, 
however  the  yaw  position  was  stabilized  as  shown '  Figure  4.7. 

Test  4  demonstrated  that  a  softer  vehicle  response,  in  yaw  position, 
resulted  from  reducing  the  yaw  position  control  gains,  as  shown  in  Figure  4.8. 
In  this  test,  greater  sway  induced  yaw  motion  was  developed. 

A  greater  range  of  motion  was  attempted  for  Test  5,  and  as  Figure  4.9 
riiows,  the  thrusters  were  saturated  fen*  a  greater  period  of  time  resulting  in 
reduced  vducle  contrd  in  yaw  position. 
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Figure  4.6  Lateral  Position  Experiment:  Test  2 


Figure  4.7  Lateral  Pomtion  Experiment:  Teat  3 


C.  LQ^K3mJDl^ULIK)6mONlNG  EXPERIMENT 


Chapter  III  dascribed  the  procedure  for  the  longitudinal  positioning 
experiment.  Inputs  firom  the  free  gyro  and  the  profiling  sonar  were  used  to 
determine  the  vehicle's  longitudinal  position  with  respect  to  the  wall. 
Position  commands  for  the  stem  propulsion  and  thruster  voltages  were  given 
using  proportMmal  derivative  contrd  laws. 

The  test  conditiims  for  the  longitudinal  positioning  eaq^riment  are  shown 
in  Table  3.2.  The  data  collected  included  range  (i^obal  X  direction)  to  the  wall, 
surge  velocity,  yaw  position,  yaw  rate,  forward  and  aft  thruster  voltage  and 
stmn  propulsicm  motor  voltage  as  functions  of  time. 

The  dynamic  characteristics  of  the  motion  for  Test  1  were  consistent  with 
the  prtqxMtional  derivative  control  as  shown  in  Figure  4.10.  A  sin^e  overshoot 
was  observed,  with  a  highly  damped  apia’oach  to  the  commanded  steady  state 
position.  The  stiction  efiects  were  observed  in  the  stem  propulsion  assemblies, 
which  resulted  in  a  small  steady  state  position  error  in  the  longitudinal  position. 

The  velocity  curve  reflects  a  greater  amount  of  signal  noise  as  the  sonar 
reaches  a  position  closer  to  the  wall. 

The  yaw  position  curve  reflects  the  motion  induced  by  the  stem  propulsion 
motors  operating  independently  with  different  levels  of  stiction. 

The  thruster  voltage  curve  shows  that  small  thruster  control  efforts  were 
generated  to  correct  the  yaw  motion.  Although  identical  voltage  signals  were 
generated  for  both  stem  propulsion  motors,  the  negative  value  of  the  right 
I»r<qmlsion  motor  was  plotted  for  clarity.  Saturation  was  observed  for  both 
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Figor*  4.10  Lmigitudiiial  Position  Exporimrat:  Test  1 
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moton  fiiUoiPtd  hy  direction  i«v«ni^  to  adiMfve  the  commanded  ateady  atate 
poaition. 

For  Teat  2,  a  final  commanded  poeition  cloeer  to  thk>  tank  wall  (5.0  feet) 
waa  attenqited.  Aa  ahown  in  Fifure  4.11,  the  atem  iwqpulaion  motora  were 
aatorated  for  a  greater  perMd  of  time  and  a  hi^Mr  aurge  velocity  waa  reached 
ednch  reaulted  in  greater,  reveraing  elfiirt 

Additionally,  aa  the  aonar  apent  a  greater  amount  of  time  in  cloaer 
proximity  to  the  wall,  the  range  input  became  unatable.  Thia  effect  produced  a 
greater  amount  of  noiae  in  the  lateral  range  and  aurge  velocity  plot. 

The  aame  commanded  poaition  waa  attempted  for  Teat  3,  however  a  bwer 
aonar  gain  waa  uaed  (9  vice  13).  Figure  4.12  ahowa  that  the  aame  motion 
reauHed  with  leaa  noiae  produced  in  the  range  and  velocity  aignala. 

For  Teat  4,  the  aonar  gain  waa  reduced  further  (to  5),  however  very  little 
improvementa  in  the  motion  or  the  mrium  levela  were  obaerved,  aa  ahown  in 
Figure  4.13. 

Figure  4.14,  for  Teat  5  demonatratea  the  repeatability  with  the  aame 
reaulta  aa  Teat  4. 

A  very  aggreadve  approadi  to  the  wall  waa  attempted  for  Teat  6  uaing  a 
commanded  poaition  of  2.5  feet.  Figure  4.15  ahowa  that  frequent  voltage 
adiuatmenta  were  generated  to  the  atem  jnopulaion  motors  whidi  reaulted  in 
ali^t  oadllationa  in  longitudinal  poaition  and  velocity  aa  the  vehicle 
iqiproadied  the  ateady  atate  poaition. 
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lent:  Test  4 


Figure  4.14  Longitudinal  Pomticm  Expmment:  Teat  6 


1 


TIm  IwgMt  rangt  of  molioD  (12.0  to  3.0  foot)  was  demoostratad  fiir  Teat  7. 
fifora  4.16  ahows  a  vary  good  af^proach  to  the  commanded  steady  state 
kagitudina^  Twaitioii  without  the  oaciHatkiQS  observed  for  Test  4. 
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Figure  4.16  Longiiudinal  Position  Experiment:  Test  7 
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a  THBOTEnCAL  MODEL 

This  Bection  presents  a  theoretical  model  for  the  horizontal  plane 
maneuvering  of  the  AUV,  during  hover  conditions.  The  development  of  the 
mo^  is  discussed  in  this  section  along  with  the  results,  which  compare  the 
actual  motions  of  the  AUV  II,  determined  experimentally,  with  those  predicted 
by  the  model. 

1.  Tlieoretical  Mo<M  Devdopment 

The  purpose  of  developing  this  theoretical  model  of  the  AUV,  is  to 
provide  the  capability  to  predict  its  motion  under  various  maneuvering 
conditions.  These  results  provide  the  basis  for  the  development  of  a  model 
based  control  system,  whereby  the  predicted  vehicle  positions,  velocities  and 
accelerations  during  a  particular  maneuver  are  compared  to  the  actual  vdiide 
motions  to  produce  an  error  signal  which  is  then  used  to  generate  a  corrective 
control  signal.  The  model  so  developed  is  particular  to  the  NPS  AUV  II  vehicle 
although  its  structure  may  be  generalized  to  other  vehicles  if  specific 
coefficient  values  for  those  other  vehicles  were  determined. 

For  the  development  of  the  AUV  model,  the  simplified  case  of 
hcnizontal  plane  maneuvering  is  considered.  Table  4.1  lists  the  symbols  and 
variables  used  in  the  model  development.  The  variables  used  are  referenced  to 
the  global  and  body  fixed  coordinate  systems  of  Figure  3.4.  Only  those 
variaUes  applicable  to  two-dimensional,  horizontal  plane  motion  are  shown.  A 
dot  over  a  vaiiaUe  indicates  the  time  derivative  of  that  variable. 

In  the  case  of  horizontal  plane  maneuvering,  the  assumption  was 
made  thgt  the  center  of  mass  of  the  vehicle  is  below  its  body  fixed  origin  (so 
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TABLE  4.1  AUV  MODEL:  SYMBOLS  AND  VARIABLES 


OymboiATMTialiM 

Descriptkm 

X.Y 

Distance  along  i^obal  coordinate  axis 

x.y  ' 

Distance  along  body  fixed  coordinate 

sods 

u,v 

Velocity  component  (surge,  sway) 
along  body  fix^  coordinate  Oc,  y)  axis 

r 

Angular  velocity  component  (yaw 
rate)  about  body  fixed  coordinate  (z) 
axis 

X..Y. 

Force  component  along  body  fixed 
coordinate  axis 

N_ 

Moment  component  about  body  fixed 
coordinate  (z) 

Yawang^ 

m 

Mass  of  AUV  II 

In 

Moment  of  inertia  about  the  body 
fixed  comtiinate  (z)  mria 

K 

Extenoal  force  ajqdied  to  the  v^de 

M. 

External  moment  applied  to  the 
vehide 

Subccripts 

f 

External  force  or  moment  component 
due  to  net  hydrodynamic  loads  on  the 
vehide 

uu,  w,rr 

Hydrodynamic  force  or  moment 
component  due  to  square  law  drag 

u,v,r 

Hydrodjmamic  force  or  moment 
component  due  to  added  mass 

Prop 

Stem  propulsion  motor 

Thrust 

Thruster 

tluitiQiip(Mitiv«X  wliUejKoandyGttreiero.  Additkmally,  it  was  sMumed  that 
tha  inartial  propartaaa  of  tha  AUV  are  ^mmetric.  Therefore,  the  motions  of 
mtereet  involve  only  the  variables  u,  v  and  r  (surge,  sway  and  angular  yaw 
velodtiea). 

The  equatimis  of  motion  for  tlw  AUV  were  then  written  as  follows: 
musmvT'i-Xf 
mv*-mur+Yj 

4'  =  r 

X*ucos4'-vsin'F 

Y  =  u8in4'  +  vco8'P 

In  the  above  equations,  Xf,  Yf  and  Nf  are  changes  in  hydrodynamic 
forces  on  the  vehicle  body  resulting  firom  propulsor  action  and  vehicle  motion. 
They  arise  ficmn  hydnx^ynamic  lift,  drag  and  added  mass  origins.  It  was  further 
assumed  that  for  hover  conditions,  lift  forces  arising  firom  small  angles  of  drift, 
were  minimal.  The  forces  acting  on  the  vehicle  were  then  limited  to  added 
mam  effects,  drag  and  the  maneuvering  forces  generated  by  the  thrusters  and 
stem  propulrion  motors. 

The  drag  fOTces  were  modeled  as  being  proportional  to  the  square  of 
the  velocity  using  the  absolute  value  to  account  for  direction.  Using 
dimensional  hydrodynamic  coefficients,  the  external  force  and  moment 
equations  were  asstimed  to  be  sinqdified  to  the  following  eiqiressions: 
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X, -X.u+X.oH+F^, 

Y,  -  Y.T+ Y^+ Y„»|v|+Y^+Fn« 

N,  •N^+N,*+N^|+N„v|»)+M*^ 

Substituting  these  eipressions  in  to  the  equations  of  motion  resulted 
inthefiiOowing: 

mu  *  mvr + X^u + X^u|uj+ Fp,^ 

mv  *  -mur + Y*  V + Y4* + Y^  v|v| + Y„r|rl + F^w 

*  N^r + N*v  +  N„r)r|+ N^v|v|+ 

T  =  r 

X  =  ucosM'-vsin'F 
YsusinT+vcosV 

Unlike  standard  maneuvering  equations  of  motion,  the  square  law 
drag  tenns  do  not  nondimensionalize  into  a  set  constant  coefficient  ordinary 
differential  equations  with  definable  stability  limits  independent  of  nominal 
fiaward  q;>eed. 

S.  Estfanatioacffflw  Hydrodynamic  Coefficients 

Relarively  accurate  values  for  certain  hydrodynamic  coefficients 
(X^,X^,Y^,Yf,N^  and  N^)  in  the  equations  of  motimi  have  been  developed 

s 

and  eiperimentally  verified  by  Warner  (1991),  however  these  hydrodynamic 
ooefficisiits  were  determined  at  mudi  faii^or  vehicle  velocities  than  that  which 
wotdd  occur  during  hover  positkniing.  Additionally,  no  previous  estimates  were 
availiMe  for  the  remaining  hydrodynamic  coefficients  for  the  square  law  drag 
(Y^.Y„,N^  and  N„X 
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To  dotormino  osiimatet  of  tho  hydrodynamic  coeflicients, 
coa^Muriaona  batwoen  the  theoretical  model  and  the  expmimental  data  were 
made. 

A  computer  program  uaing  Eul«r  integration  methoda  waa  written 
uaing  the  equationa  of  motion  to  aimolate  the  motion  of  the  AUV  in  the 
horiiontal  plane.  Tlie  code  for  the  MATLAB  (trademaih  of  Math  Worka,  Inc.) 
fwogram  ia  provided  in  Appendix  G.  Aa  a  atarting  point,  the  hydrodynamic 
co^denta  determined  by  Warner  (1991)  were  uaed.  In  addition,  the 
hydrodynamic  coeffidenta  for  the  linear  drag  were  uaed  aa  first  eatimatea  for 
the  square  law  drag  hydrodynamic  coeffidenta. 

The  pn^pram  was  run  for  each  of  the  three  positioning  experiments, 
comparing  the  results  for  one  particular  test,  firom  each  experiment.  The 
coeffidenta  were  adljusted  so  as  to  achieve  the  best  agreement  between  the 
model  and  the  experimental  data,  with  the  hydrodynamic  coeffidenta  commmi 
for  all  three  types  of  positioning  experiments.  The  hydrodynamic  coeffidenta 
were  adjusted  to  one  significant  digit.  TaUe  4.2  lists  the  initial  and  final  values 
far  the  hydrodynamic  coeffidenta. 

A  large  diffmence  was  noted  between  the  initial  and  final  values  for 
Xou.  The  initial  value  was  derived  for  the  case  where  the  vdiide  was  moving  at 
a  nominal  steady  state,  average  q)eed  of  1.5  feet  per  second  (Warner,  1991). 
Under  these  ccmditions,  the  stem  propulsion  motors  are  operating  with  a 
throat  reduction  effect  due  to  the  forward  motion  of  the  vdiide.  Hus  thrust 
reduction  can  be  modeled,  aimilariy  to  dra|^  by  a  aquare  law  force  as  follows: 


TABUS  AUV II  HYDRODYNAMIC  COEFFICIENTS: 

HOVER  CONDITIONS 


HYDIIOYIIMIIC 

COBPrZClBNTS 

Xuu 

Xudct 

Yvv 

Yrr 

Yvdot 

Yrdot 

Nvv 

Nrr 

Nvdot 

Nrdot 


INITIAL 

VALUB 

■0.4024 

■0.00282*377.67 

-0.10700*51.72 

0.01187*377.67 

■0.03430*377.67 

■0.00178*2756.81 

■0.00769*377.67 

■0.00390*2756.81 

■0.00178*2756.81 

■0.00047*20137.50 


PINAL 

VALUE 

■3.0 

■0.06*377.67 

■0.5*51.72 

0.01187*377.67 

■0.04*377.67 

■0.00178*2756.81 

■0.00769*377.67 

■0.04*2756.81 

■0.001*2756.81 

■0.002*20137.50 


. . .  wiw* 


Fp»,«P.+X,^u|u| 

iriitrt  F«  it  the  iMmunal  etatic  iorct  of  Um  item  propulnon  moUv  equal  to  five 
pounda  (Saundera,  1990). 

Tbe  final  value  of  Xuu  firom  TaUe  4.2  can  be  conaidered  to  be 
repreaentative  of  the  combined  ^ecta  of  drag  and  thruat  reduction  auch  that 
(to  one  decimal  place): 

Xm  (fM)  *  Xaa  ***  X^  (Mact) 

^w(Dn«)  ® 

X,. -2.6 

Theae  reaulta  predict  a  ateady  atate  apeed  for  the  vehicle,  at 
maaimum  voltage,  of  1.3  feet  per  aecond. 

3.  T1ieM«tical  Model  Raanlta 

Compariaon  between  the  experimental  data  and  that  predicted  by  the 
thewetical  model,  for  the  yaw  poaitioning  experiment  ia  ahown  in  Figure  4.17. 
The  reaulta  fiv  a  90  degree  teat  are  ahown.  The  yaw  position  curve  shows  that 
leas  overshoot  is  predicted  by  the  model  than  that  measured  experimentally, 
however  the  vehicle  approached  the  final  commanded  position  with  less 
oscillation.  Similar  dynamic  characteristics  are  seen  in  the  yaw  rate  and 
thruster  voltage  curves. 

The  results  for  the  lateral  poaitioning  experiment  are  slmwn  in  Figure 
4.18.  A  conqMuriaoncrf’ Test  3  (aee  Table  3.2)  ia  shown.  The  lateral  position 
curve  shows  similar  dynamic  characteristics  between  the  model  and  the 


78 


Flgwrs  i.17  AUV  Mod^  Yaw  Positaon  Ezperimoit 


•xpMiBMntal  data,  howavw*  the  modal  raachad  a  peak  velocity,  of  smaller 
amgnitiide,  eoonsr  than  the  v^iicle. 

Similar  dynemic  characteristics  are  diown  in  the  yaw  position  curve 
fiw  the  lateral  positioiung  experiment  as  wore  observed  for  the  yaw  positioning 
experiment  The  model  shows  less  overshoot  and  a  more  oscillatory  approach 
to  the  final  commanded  position  than  the  data.  The  difierence  in  the  steady 
state  poeiticms,  due  to  the  stiction  in  the  vehicle's  thrusters  is  also  shown. 
Similar  features  acaahown  in  the  thruster  voltage  curve. 

Figure  4.19  shows  the  results  for  the  longitudinal  positioning 
experiment  comparison.  The  comparison  was  made  for  Test  7  (see  Table  3.2). 
Very  good  agreement  is  shown  between  the  model  and  the  data  for  the 
longitudinal  range  and  surge  velocity  curves.  The  model  shows  the  same 
overshoot  as  the  data  with  only  a  slightly  oscillatory  approach  to  the  final 
omunanded  position.  A  slight  difierence  in  peak  value  and  time  of  occurrence 
is  shown  in  the  velocity  curve.  The  same  characteristics  are  shown  in  the 
stem  propulsion  vdtage  curve. 

The  stiction  in  the  thrusters  and  stem  propulsion  motors  is  shown  in 
the  difierence  between  the  yaw  positicm  curves  for  the  model  and  the  data. 
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V.  SUMMABT 


Tliis  dia|»ter  documents  genersHsed  condusions  ci  the  results  presented 
in  Chapter  IV.  £^;Mcific  oomments  regarding  the  level  of  success  in  meeting  the 
oldectives  of  this  study  are  included.  Recommendations  for  areas  of  further 
study*  related  to  the  concepts  focussed  in  this  thesis  are  made. 

A.  CONCLUSIONS 

Throu^  the  course  of  this  study,  the  ability  to  achieve  accurate  acoustic 
positicnung  capabilities  of  the  NFS  Autonomous  Underwater  Vehicle  (AUV II) 
under  hover  conditi<ms  was  denumstrated. 

Use  of  an  independent  self-sonar  which  provided  environmental  imaging 
data  without  the  aid  of  a  transponder,  along  with  the  inputs  from  a  free 
directional  gyro  system  provided  adequate  data  from  which  to  base  vehicle 
positioning  commands. 

Execution  of  the  maneuvering  commands  through  the  use  of  stem 
prqpulsi<m  motors  and  lateral  tunnel  thrusters,  proved  vital  in  achieving  the 
ability  to  accurately  position  the  vehicle,  based  on  sensor  data  inputs. 

The  results  of  the  yaw  positioning  experiment  showed  that  an  accurate 
final  commanded  angular  position  can  be  achieved  using  the  yaw  position 
inputs  from  the  firee  directional  gyro  system  and  maneuvering  commands 
esecuted  by  the  thrusters. 


lilf 


Aocurmte  lateral  and  longitedinal  positicming,  in  the  vicinity  of  a  local 
was  achieved  through  the  ccanlnned  input  data  firom  the  gyro  and  the 
ystrais,  and  the  oondnned  maneuvering  efforts  of  the  stem  propulsion 
and  the  thrusters.  Hie  stability  the  positioning  data  relative  to  the 
howsfvar  was  d^iendent  on  the  gain  (rf  the  scalar.  Overdriving  the  sonar 
transducer  resulted  in  unstable  positioning  data.  This  indicates  that  in  future 
missions,  an  automatic  "sonar  supervisor"  must  be  included  in  the  control 
software. 

The  proportional  derivative  control  law  employed  to  generate  the 
maneuvering  commands  produced  the  ocpected  vehicle  motion  dynamics.  The 
ability  to  change  the  dynamic  motion  characteristics  (overshoot  and 
oscillation),  was  achieved  by  adUusting  the  control  law  gains. 

In  the  cases  where  the  control  effort  was  governed  by  a  combination  of 
position  errors  (yaw  position  and  range)  as  seen  in  the  lateral  and  longitudinal 
positioning  experiments,  the  stability  of  the  positioning  ability  was  dependent 
on  the  coupling  effects  of  the  two  directions  of  motion.  The  motion  became 
particularly  unstable  in  the  situations  where  the  position  errors  resulted  in 
saturation  of  the  thrusters. 

Motor  sticticm  affected  the  error  in  the  final  commanded  positions,  in  all  of 
the  positioning  experiments.  The  level  of  stiction  in  the  thrustere  limited  the 
ability  to  achieve  the  final  commanded  yaw  position  and  lateral  rc  Te  in  both 
the  yaw  and  lateral  positioning  eiq)eriments.  The  experimental  results  showed 
that  the  level  of  stiction  was  not  identical  for  both  thrusters,  nor  was  it  the 
same  for  either  direction  for  one  thruster. 
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TIm  Molar  tlkliMi  oflbolo  won  owtoontd  fai  tiio  eaoe  of  tlio  IwnfitwHnal 
pooMoatef  wpirtimnt  a4tro  Ibo  olon  propuloiiM  meloro  gonorated  •  ymm 
MMMMl  on  tiM  voideio,  wMcb  woo  bolow  tiio  tiiroohold  of  the  lateral  tloniotor 

The  roonilo  of  the  thoorotieal  modd  prooidod  adoqoate  data  to  oupport  a 
oMdd  haood  eontrol  olfert,  bowofror,  oovoral  effoeto  adddi  ware  beyond  the 
oeopeefthteotady*  wore  not  kidiided.  Seine  of  which  indude  the  following: 

1.  Motor  fltietion,  ae  prevkmdy  dieeuseed. 

2.  Cfoangee  in  thmoter  md  stem  pn^mloicm  fmree  effects  due  to  dianges  in 
the  adodty  of  the  vehide. 

3.  Changes  in  dfects  of  the  hydrodynamic  coeffidents  due  to  dianges  in 
vohide  velodty. 

B.  RBCCHffliENDAlIONSroRFUBTHERSIVDT 

Tins  theds  exmined  the  first  experiments  conducted  to  study  the  ability 
of  tho  NFS  AUV  U  to  achieve  acoustic  dynamic  positioning  during  hover 
conations.  As  a  reoalt»  several  rdated  areas  requhe  further  research. 

Proportional  derivative  control  laws  were  used  to  generate  the  positifniing 
oonuMmds  for  the  AUV  with  fovoraUe  results,  however  optinuzati<m  oi  the 
eontrol  law  gains  io  stfil  required.  In  addition,  othnr  types  of  contrd  methods 
which  miqr  be  incorporated,  shoidd  be  studied.  In  particular,  sliding  mode 
eontrol,  uoing  model  hosed  command  generators,  should  be  examined  finr  its 
suitability  to  export  djynaaaicpositiontog  behaviors  wiffwut  driving  thrustws 
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Farthtr  wwk  it  rtquirtd  in  Hm  artt  of  modtUng  tht  motion  of  tlit  AUV 
dorii^hoivoreonditiont.  GtitainarMiofeonotm,todiMtbnittoranditorn 
ptofwliion  motor  ttiniot  ofibelivtnMO  and  bydntl^itmic  fiircoi  reqpnro  fiirthor 


imemthifgonowJiattiontoftho  modal  wort  to  be  purtuod. 

Kqporimenta  dMmld  be  omdocted,  to  vmify  higher  levdt  of  mitonmnoua 
operation  bgr  examining  more  con^dez  aaotion  behaviora,  including  limger 
miaaiona,  combining  motiona  commanded  in  aequenee  or  aimultaneoudy,  uamg 
•ither  timed  baaed  or  aenaocy  data  baaed  iiqjuta  aa  the  baaia  for  the  aelection 
ofbehaviora. 

Uaing  aonm  to  identify  ohiecta  of  intereat  within  the  fidd  of  view  ahould  be 
integrated  imo  the  capabihtiea  of  the  robot  aubmarine,  aHhoui^  ddaya  in  the 
availability  of  pooition  rdated  infiamation  are  Hkoly  to  cauae  poaitional  motion 
inatability.  A  atudy  and  devel(q>ment  of  model  baaed  predictm/corrector 
control  la  hkefy  to  be  a  laquirement  far  HMantainingatribleconibined  motion. 

Inveatigationa  of  diatorbanoe  reapcmae  in  the  preaence  of  water  current 
could  and  Aould  be  conducted. 
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MJC/UfT-Kl 

MCM 

mm  SIS 

MCM 

7 

•  CM 

1 

MCM 

f 

M  CM 

MCM 

11 

MT/KX-KI 

SU  * 

ICIl^  SMUT  T13 

12 

H  CM 

»TNCB1IMII 

Km  cai  TMm 

TMO  PRSK  B6MS 

1 

M  conn 

M 

2 

WT 

PON  B4  VDC 

FUK  BLK  1  (RASTER  KLAY) 

GM/SEF 

3 

BLK 

GM/KF 

MR  REF  BUSS 

SIS  OUT 

4 

UHT 

PULK  SI6 

TIN  MKDUT  T4 

SIS  IN 

5 

UHT 

SIS  ^  INP 

PROK  vi«  4  PIN  TWI-H  Tl  *  RED  (C) 

SIS  REF 

6 

GAN 

SIS  IV  KF 

PROBE  vi«  4  PIN  THR-H  T3  *  BLK  (0) 

TUSBO  PSBK  1MMS 

SIS  * 

UHT  IN  AUV 

RES  iC) 

^  SIS 

TIHIBO  P  CARD  via  FLY  CONN  *  4  PIN 

GPS  SECEIKR 

GPS  SIFF.  KGEIKI 

S16  REF 

CM  IN  AUV 

BLK  (D) 

SIS  REF 

TURBO  P  CARD  via  FLY  COHN  i  4  PIN 

vs  MfliMM 


THhlS  sltt? 

10 

fill  1 

4 

YEU 

RPNS16 

PT  SCREN  RPN  T3 

SIS  IB  (AlltSiS) 

B 

INtoZ 

3 

GR6 

RPN  SIS 

STID  SCKH  RPN  T3 

na.  SK»r 

A 

VOnS 

4 

WT 

RPff  SIS 

TURBO  PRDK  T4 

(IMT) 

4 

|ttt4 

1 

3 

frtt  5 

2 

If 

M 

a 

SRt 

GM 

FIN  KRVO  SOARS,  S» 

» 

M 

24 

BUY 

M 

FIN  SERVO  BOARD,  SNI 

hi 

♦ISMC 

RO-SM 

M 

TERN  0  SL  5  DRKOUT 

TIlhM  flats 

10 

Iftt  1 

f 

BRN/ILK 

RPN  111 

F.V.  THR  RPN  T3 

AliHB  MlfMi 

B 

IfttS 

10 

Vlfll 

VN  ii| 

F.H.  THR  RPN  T3 

ncL.  isan 

4 

|»tt3 

7 

KB/WT 

RPR  fi| 

A.V.  THR  RPN  T3 

flMF) 

Ifitf 

1 

mmx 

RMiii 

A.N.  THR  RPN  T3 

3 

llttS 

S 

If 

M 

13 

MV 

M' 

FIN  SMVO  SBIW,  M 

IB 

M 

14 

MV 

M 

FIN  SavO  MAM,  M 

l>2 

MMC 

IDMB 

M- 

TERN  0  SL  S  MKOUT 

THhIl  MIt 

1  Mi  1 

11 

VIOL 

CNTIL 

FW  TOP  FIR.  T  1 

Ml  m 

S  Mil 

12 

m 

am 

FM  801  FM.  T  1 

MU  WM' 

f  Mil 

14 

an 

am 

FW  8Tn  FIR,  T  1 

MMIt) 

11  Mi  4 

13 

Kl 

am 

FW  NRT  FIR,  T  1 

SMtacrni 

17,11,19,20 

Umt 

SVIC 

FIR  SERVO  IRJECTIBR  lOMD 

13  MtS 

14 

17  Ml 

IS 

If  M 

23 

«v 

8W 

FIR  SERVO  MMS.  8W 

10  M 

24 

■lY 

Ml 

FIR  SERVO  lOMS.  6W 

1>I  «12flC 

KHIK 

rau 

TERR  0  8L  5  NKOUT 

Tm-M  SLir  10 

7  Mi  1 

17 

WT 

am 

Ift.  FIR,  T»p 

MO  m 

S  Mt  2 

18 

MN 

om 

Ift.  FIR,  BettM 

na.  Nnn 

f  Mt  3 

20 

6RN 

OiTRL 

Ift.Fin,  STID 

IfltfTNT) 

11  DVt  4 

19 

m 

am 

Ift.Fin,  Ptrt 

S  OC  IIOECTIW 

17.18.19.20 

UHT 

5  V9C 

FIR  MRVO  imECTION  BOARD 

13  out  S 

22 

15  FmI 

21 

If  6» 

23 

m/m 

IRTERR  END  +  FIR  SERVO  BOARD  6RD 

20  fi» 

24 

m/m 

IRTERR  6RD  *  FIR  SERVO  BOMS  6RD 

25 

MY 

m/m 

JUMPED  TO  T23 

24 

MY 

m/m 

JUHPED  TO  T24 

1»2  «i2vgc 

MD-M6 

m 

TERR  0  SL  5  MKDUT 

OOC-21  SLOT  11 

1 

27 

MEY 

m/m 

PMT  S  SERV  T5 

M  Ml  (05) 

2 

30 

RED 

Ch.l 

PORT  S  SERV  T4 

IKL  NKnn 

3 

29 

6REY 

m/m 

STBO  S  SERV  T5 

OMLK  S16.  OUT 

4 

32 

MS 

a>.2 

STBD  S  SERV  T4 

5 

31 

BREY 

EF 

F  V  TH  SERV  T5 

4 

34 

BLUE 

GH.. 

F  V  TH  SERV  T4 

7 

33 

BMY 

6ND/REF 

F  H  TH  SERV  T5 

0 

34 

BLK 

01.4 

F  H  TH  SERV  T4 

9 

35 

SIIEY 

GW/REF 

A  V  TH  SERV  T5 

10 

38 

YEL 

CH.4 

A  V  TH  MRV  T4 

11 

37 

fltEY 

8»/flEF 

A  H  TH  SERV  T5 

12 

40 

WT 

01.4 

1  H  TH  SERV  T4 

13 

39 

m/REF 

14 

42 

Oi.7 

IS 

41 

m/m 

14 

44 

Ck.l 

17  *a  fK 

43 

HSKFW 

Intirul  BC-K  Pw 

M^lSflC 

44 

*a  K  NR 

t  ■  ■ 

19  -»  «K 

45 

>15KNR 

•  •  t 

20-lSVIC 

41 

-ISKPUR 

■  •  ■ 

MC-Z  (lOhZI)  ftT  4 

CUMOIT  HM 

0 

VIOL 

MIL.  818 

PMT  SCREH  SERVO  A  TB 

»MI  two 

CHMERT  Hr 

1 

ku 

MIL.  818 

STBD  SGREH  SERVO  A  TB 

VKL  tmt 

2 

IKKM 

QMfilT  M 

3 

m. 

MIL.  816 

F  V  TH  SERVO  MP  T8 

GMWn  Ml 

4 

WT 

MM..»t 

F  H  TH  8EW0  MP  T8 

Btten  Ml 

5 

iU) 

MIL.  m 

1  V  TH  SERVO  MP  TB 

ttMEor  in 

4 

ns 

mL.  SIS 

1  V  TH  SERVO  IMP  TB 

1 

1 

nn» 

7 

M. 

MIL.  818 

BEPTH  CEU  CAW  TIO 

y.r-tfc- 

WE  Ml 

PITQIMTE 

1 

MhiJi 

AML.  BIB 

Pick  Ratt  Byroi  PIN  B 

wnm 

Nil  MTE 

9 

ILK-ILU 

RML.  SIB 

Rail  Ratt  Syra,  PIN  1 

iwmi 

YUMTI 

10 

Hff-ILU 

m.  SIS 

Yaa  Ratt  Syrti  PIN  3 

WTRUmi 

piiGMimi 

11 

IRi 

MAL.  SIS 

Pick  A*|.  PIN  F 

mmtvm 

MUIMU 

IB 

VIOL 

AML.  SIS 

Rail  Ab|.  Syrai  PIN  K 

wm 

MTwna 

13 

WT/IU/RO 

AML.  SIS 

BATAB  SONAR  CARS,  Til 

Tin  PUP 

lA 

TRIT  KMKR? 

15 

Ml  JUNPO 

MML/lll 

PB 

HEY 

m/m 

AN/IIS  SNI  AML  P.S. 

AK'l  (ICIHBAW  SL  5 

415  VBC  SUPPLY  0 

REB/WT 

ANAL  BIAW 

4  15V  TERN  ANAL.  P.S. 

10  NEI,  AML06  P.S. 

0 

REB/0R6 

POU  415VIC 

TIN  CARBS  PIN  1,2  (A) 

INCL.  IKBin 

>15  VIC  SUPPLY  1 

REB/BU 

ANAL  B1A6N 

-  15V  TERN  ANAL  P.S. 

BIASNOSTICS 

45  VBC  SUPPLY  2 

REO 

ANAL  BIASN 

4  9V  TERN  ANAL  P.S. 

410  VBC  SUPPLY  3 

ORG'REB 

ANAL  BIASN 

4  lOV  TERN  ANAL  P.S. 

-lOVBC  SUPPLY  A 

0R6/BLK 

ANAL  BIMN 

-  lOV  TERN  ANAL  P.S. 

5 

6 
7 
B 
e 

1C 

P2  HEY  m/m  AN/II1&  6UC  ANAL  P.S. 


P1N-3N,  BO  HEI,  SL  A 
m  INPUTS  P2  VIAl 
INCL.  MKOUT 


1  412 

not  conn  NC 

2  -12 

not  conn  02 

3  45 

01 

HHT 

4  5VBC 

A  45 

OA 

5  GNB 

03 

IMT/REB 

BIG  GND 

03 

HHT 

BIG  GNB 

1  6NB 

01 

7  CB2 

05 

B  CAB 

OB 

9  Cll 

07 

10  CA! 

10 

11  PT 

09 

12  M7 

12 

13  PM 

11 

lA  PM 

lA 

15  PM 

13 

11  PM 

11 

17  m  IS 
II  PM  II 
19  PB3  17 
BO  PI3  BO 
B1  PK  19 
BB  PIB  BB 
B3PI1  B1 
BA  Ml  BA 
BSPM  Bl 
BAPM  Bl 


TD  SERVO  AMP  INVERTOR  CHIP 

FROM  FR  GYRO  PIN  9 
TO  SERVO  AMP  INVERTOR  CHIP 


nmi  HKciTE 

nail  MiciTE 


irn 

Hbt 


TTL  LO/TMI  FREE  BY  BKS.  PIN  B 
TTL  LO/1RUI  FREE  6R  DBBS,  PIN  15 


PIMI  CM*t*  iM  4 

1  «li  Ml  CMM 

f  ■PWpR  ^•'  Wiw 

I  ~tt  Ml  CMM 

mwm 

1  «S 

a 

R  n 

n 

S  Mi 

30 

R  W 

a 

7  CM 

a 

i  CMl 

« 

9  cn 

M 

well 

a 

11  Fi? 

34 

r.i.  mm 

It  M7  *h  19V 

a 

Ml 

TTL  Ml/TRU 

RNRL  F.S.  T  re-1 

13  FM 

a 

f,%.  mm 

14FM»9V 

37 

Mil/4r» 

TTl  il/TRU 

RML  F.8.  T  Fl-3 

19  FM 

40 

TNMiBi  fan  imiiT 

14  F«  4.N.Thr 

a 

Mt-a 

TTL  HIT  HI 

IWERTER  MRM  T  8 

17  FM 

a 

mam  ion  irniin 

11  FM  R.V.Thr 

41 

1*1-41 

m  IMIT  HI 

WVERTER  Ml  T  4 

19  Fa 

44 

TMHSTBI  KMO  IMtlllT 

20  Fa  F.H.TIir 

43 

«4t-43 

m  WIT  HI 

IRV  WO  T  45 

TIITEC  SQMR  OM/OFF 

21  Fa  IritKh 

44 

fren 

TU  LO/TRU 

RHRL  F.S.  FlO-1 

mam  sewo  iimibit 

a  Fa  F.V.TIir 

45 

i*t-45 

TTL  WIT  HI 

WV  MO  T  2 

FKE  tm 

23  FRl  UncH* 

a 

gro/bik 

m  LO/TRU 

RHRL  F.S.  FlO-2 

fxm  fan  iwiiit 

2R  FRl  Sto  SertH 

47 

■41-47 

m  WIT  HI 

WV  WO  T  17 

FKEim 

a  Fio  cm» 

90 

gm/nht 

TTL  LO/TRU 

RHRL  P.S.  PlO-3 

SOB  SERVO  INHIIIT 

24  FRO  Fert  Krcn  49 

■41-49 

m  WIT  HI 

WV  BRO  T  15  1 

> 

TTL  IMERTElFaR 

Fl(h3R  m  BBTKTS 
TOSRVOMn 

i 

[ 

R.H.  m  INNII 

T39 

8-12 

0R& 

TTL  LO/TRU 

A.H.TH  SERVO  AMP  T-11 

R.V.  TMR  mUI 

T41 

4-14 

GRN 

TTL  LO/TRU 

A.V.TH  9ERV0  AHP  T-11 

F.R.  TMR  INNII 

T43 

4-14 

m 

m  LO/TRU 

F.H.TH  SERVO  AHF  T-11 

F.V.  TMR  ilKlI 

T45 

M8 

MX 

TTL  LO/TRU 

F.V.TH  MRVO  AHP  T-11 

Sn  SCREM  itni 

T47 

17-3 

VIOL 

TTL  LO/TRU 

STO  SOIR  SERV  Aa  Til 

PRT  SCRER  INHIi 

T49 

15-5 

ILUE 

HL  LO/TRU 

PT  SCRR  MRVO  AK>  Til 

miL  NR,  IRCeUT 

T1 

1,10,19 

IRiT 

PHR 

PIA-3A  MKOUT  T1 

M,  FIR  IRHUT 

T3 

20 

WT 

116  SIB 

PIA-3A  MKOUT  T3 

I  RFl-1  ■Mrm  7W  hn  tltt  IRV,I,7)  tl»t  12 

1  Hi  RROn.  lOECT  FLRT  UHIRI  GW. 

f 

1  mm  m  »  fir  gw.  hr  rfm  mm  frri  syNCMo  mds 

t 

1 

1  ill  siptlt  to/fm  re  to  Syncrt  to  liaitoi  fiarV  frai  N 

i 

re  FwKittii  itfMl 

re  FmetiM  SifMl 

1 

1  H2 

2  -12 

3  n 

4  *9 

s  w 

4  M 

! 

7  GK 

i  CM 

9  Gil 

10  CM 

I  11  FT  Hit  Iflkikit  It  FfT 

ill  7 

13  FM  iny 

14  FR4 

lit  4 

1 

19  FK  iit» 

14  Fa 

1119 

17  FM  Htlt 

li  FM 

lit  4 

If  FM  Mtll 

a  FM 

lit  3 

11  FK  Mtli 

a  FM 

lit  2 

a  FM  tttf 

M  FM 

lit  1 

a  FM  Mti 

»  FM 

lit  0 

O  li  cmmkHm 

a  M  Cl 

MMCttoa 

■ 

a  TiwriMi  a 

W  Tl«r  MIcO  a 

1  ...  . 

■  littl  K 

*  btrt  K 


Vl'l  CM*ti  ft}»t  It 

M 

PH  1 

lltMl 

M 

TmHMi.  It,  NKT 

CR  M  |li  CMS. 

K 

put 

MIWKcMi. 

nt 

PINS 

III^ 

CMN 

THMHtti  M,  m 

M  MWTi  mOT  CM 

K 

PIN  4 

m 

PINS 

iii>m 

CM 

TMtHHl  12,  lU 

UK 

PM  A 

ITS 

PINT 

SCI 

PM  1 

ns 

PM  9 

NC 

PM  10 

KSEIMI  MM 

MT«  n 

PM  3 

IIBSON.  MS 

RS  IX 

10  PIN  FHARI  THMhWJLL  COM,  PIN  3 

RS2fi>  TR11EH  MFlLEt 

MITA  MT 

PM  5 

AiB,  sm 

IS  232 

10  PIN  PNARI  THRU-NULL  COHN,  PIN  4 

am/KEp 

PIN  13 

III,  MS 

RS  232 

10  PIN  FHMB  TMU-HULL  CONN,  PIN  2 

M  m,  TtiTECH  seme 

MTA  IN 

PIN  3 

RIB,  MS 

RS  232 

10  PIN  FHARI  THRU-NULL  CONN,  PIN  9 

MTA  flUT 

PINS 

RIB,  6RN 

RS  232 

10  PIN  FHARI  TNMHRiL  COHN,  PIN  B 

6NI/REF 

PIN  13 

RIB,  MS 

RS  232 

10  PIN  FHARI  THRU-NULL  CONN,  PIN  6 

iimMHKC  cmmmmoKUkwmcMJcmATim 

flw  eriwtoHm  tOim  ow^tr  tf  pwity  fcr  tin  AUV  to  pftviitd  an  tki 


flw  Mdi  tlMM  ihowa,  Um  hcatiaii  of  its  individiHil  oMikir  of  gravity, 
ralothro  to  tlM  X  aad  Y  di^nm,  it  liotod,  oloBf  wHIi  ita  woiglit  and  firat 
mniiiifi  in  tiM  X  and  Y  diraeliona.  Tha  toeation  of  tha  eentar  of  gravity  ia 


BUOYANCY  TEST  08/04/94 


ITEM 

Xin 

Yin 

Wt( lb) 

Mx 

My 

FWB  VERT  THRUSTER  ASSY 

14.0 

10.0 

5.0 

70.0 

50. 

.0 

FUD  HORIZ.  THRUSTER  ASSY 

6.3 

7.0 

5.5 

34.4 

38. 

.5 

APT  VERT.  THRUSTER  ASSY 

49.0 

e.5 

5.0 

245.0 

42. 

.5 

AFT  HORIZ  THRUSTER  ASSY  . 

56.0 

6.5 

5.5 

308.0 

35, 

.8 

MASTER  RELAY 

10.0 

11.0 

0.5 

5.0 

5. 

.5 

BATT.  COMPUTER,  ANALOG,  2  FUD 

20.5 

8.0 

54.0 

1107.0 

432, 

.0 

BATT.  MOTORS,  SONAR,  2  AFT 

41.6 

7.6 

54.0 

2254 . 5 

410, 

.4 

B1L6E  PLATES,  2  FWD 

9.5 

8.0 

3.2 

30.4 

25, 

.6 

BXLSE  PLATES,  S  HID 

31.3 

7.S 

4.0 

123.4 

30. 

.8 

BILGE  PLATES,  2  AFT 

50.0 

7.6 

2.5 

125.0 

19, 

.0 

HULL  8  SERVOS,  MPROP,  4  PLATES 

33.3 

7.9 

150.6 

5007.4 

1189. 

,7 

NOSE,  EMPTY  LESS  ILB  BUOY. 

-7.5 

8.0 

1.3 

-9.8 

10 

.4 

FINS,  6,  META  CENTER  AT  C6 

31.3 

7.8 

5.1 

159.4 

39, 

.8 

THRUSTER  P.S.,  4  Midship 

31.3 

8.0 

6.4 

200.0 

51, 

.2 

MAIN  PROP  P.S. ,  2  fwd 

14.5 

6.0 

3.2 

46.4 

25, 

.6 

COMPUTER/ANALOS  P.S.  <2) 

21.0 

8.0 

4.2 

88.2 

33 

VERT.  GYRO  m/ BRACKET 

14.0 

13.0 

2.0 

28.0 

26. 

.0 

RATE  BYRO(s) 

13.0 

3.0 

3.9 

50.7 

11 

.7 

FREE  GYRO  +  MOUNT 

49.0 

2.3 

3.3 

159.3 

7. 

.5 

INVERTER  FOR  F.  GYRO 

47.5 

12.8 

1  .4 

66.5 

17, 

.9 

NUT  PLATE 

33.0 

7.8 

4.5 

148.5 

35, 

.1 

OS  9  CAGE  (right) 

31.3 

5.0 

4.2 

129.7 

20. 

.8 

OS  9  CARDS  (0.451b  x)  12 

31.3 

5.0 

5.4 

168 .8 

27. 

.0 

486  CAGE  (left)  -lead 

31.3 

10.0 

3.6 

114.1 

36. 

.  5 

486  CARDS  (0.451b  x)  3  -lead 

31.3 

10.0 

1  .4 

42.2 

13, 

.  5 

RIBBON  CABLE  INTERFACE  (4) 

41.0 

7.8 

1  .5 

61  .5 

1 1  , 

,7 

TURBO-PROBE  INCL.  MOUNT 

-2.0 

4.0 

3.4 

-6.8 

13, 

.6 

WIRING,  MISC. 

31.3 

7.8 

3.0 

93.8 

23, 

.4 

DIFF.  GPS  REC.+ANT.  (0.9LBS) 

0.0 

0.0 

0. 

,0 

GPS  RECEIVER 

0.0 

0, 

.0 

GPS  ANTENNA  +  MOUNT 

10.5 

4.5 

1.0 

10.5 

4. 

,5 

TOPSIDE  THRU-HULLS 

14.0 

8.0 

3.0 

42.0 

24. 

.0 

T725  SCALING  SONAR 

-8.0 

10.0 

2.6 

-20.8 

26. 

,  0 

T1000  PRCriLING  SONAR 

-5.0 

10.0 

2.6 

-13.0 

26. 

,0 

TRITECH  SONAR  MOUNT,  WIRES 

-7.0 

10.0 

3.0 

-21.0 

30. 

0 

DATASONICS  SONAR  +  MOUNT,  WIRE 

-4.0 

6.0 

2.4 

-9.6 

14. 

,4 

BLMDYANCY,  SONARS 

-6.0 

9.5 

-2.0 

12.0 

-19. 

,0 

BUOYANCY,  SUPP'S,  T  PROBE 

-4.0 

8.0 

-0.6 

2.4 

-4. 

,8 

TRIM  LEAD  by  F.GYRO  INV. 

51.0 

12.8 

4.5 

229.5 

57. 

,6 

TRIM  LEAD,  aft 

63.0 

8.3 

5.9 

371.7 

49. 

.0 

TRIM  LEAD,  aft  of  computers 

38.0 

7.8 

8.9 

338.2 

69. 

,4 

TRIM  LEAD 

51.0 

4.0 

5.0 

255.0 

20. 

,0 

TRIM  LEAD,  fwd  of  computers 

24.5 

6.5 

4.4 

107.8 

28. 

,6 

TRIM  LEAD,  tweak 

38.0 

8.3 

0.3 

13.3 

2. 

,9 

TOTALS 

C.G.,  X,Y  INCHES  FROM  DATUM 

Ibs-TOT 

388.5 

12155.2 

31.29 

3010.7 

7.75 

EST.  RESERVE  BUOYANCY  (FRESH)  -  LBS.  0.5 

NOTES  X  DATUM  IS  FORWARD  OUTER  HULL  EDGE,  POSITIVE  AFT 
Y  DATUM  IS  INNER  STBD  HULL  SIDE,  POSITIVE  TO  PORT 
DRY  C.G.Cin)  X,Y  31.25,  7.75 


CMM  BixnMiKnr 


outfit 


Par  omIi  Warn  ohowii,  Hm  loeotioii  of  ito  intfirkiiMl  ooiitor  of  fr«oity» 
nMvo  to  tfw  X,  Y  and  Z  dotoao,  io  liotod,  oloof  wHh  ito  woifht  and  firot 


AUV  NEW  CBC6  (CTR-BUOY  CTR-GRAV  SEP) 


0£/04/94 


ITEM 

Xin 

Yin 

2in 

Wt( lb) 

Mz 

FMD  VERT  THRUSTER  ASSY 

14.0 

10.0 

4.8 

5.0 

83.8 

FMO  HORIZ.  THRUSTER  ASSY 

6.3 

7.0 

4.8 

5.5 

86.1 

AFT  VERT.  THRUSTER  ASSY 

46.0 

6.5 

4.8 

5.0 

83.8 

AFT  HORIZ  THRUSTER  ASSY 

56.0 

6.5 

4.B 

5.5 

86.  1 

MASTER  RELAY 

10.0 

11.0 

1.0 

0.5 

0.5 

NUT  PLATE 

33.0 

7.8 

9.5 

4.5 

48.8 

BIFF  BPS  REC.+  ANT 

. 

0.0 

^8  RECEIVER 

0.0 

0.0 

0.0 

0.0 

0.0 

SPS  ANTENNA,  MOUNT,  WIRING 

10.5 

4.5 

13.0 

1.0 

13.0 

BATT.  COMPUTER,  ANALOG,  S  FWD 

80.5 

6.0 

3.5 

54.0 

189.0 

BATT.  MOTORS,  SONAR,  S  AFT 

41.6 

7.6 

3.5 

54.0 

189.0 

BILGE  PLATES,  B  FWD 

9.5 

8.0 

0.4 

3.8 

1.3 

BILGE  PLATES,  8  MID 

31.3 

7.8 

0.4 

4.0 

1  .6 

BILGE  PLATES,  8  AFT 

50.0 

7.6 

0.4 

8.5 

1.0 

HULL  8  SERVOS,  MPROP,  4  PLATES 

33.3 

7.9 

4.8 

150.6 

715.4 

NOSE,  EMPTY,  less  1  lb.  buoy 

-7.5 

8.0 

4.8 

1.3 

6.8 

FINS,  8,  META  CENTER  AT  CG 

31 .3 

7.8 

4.8 

5.1 

84.8 

THRUSTER  P.S.,  4  midship 

31.3 

8.0 

4.5 

6.4 

88.8 

MAIN  PROP  P.S.,  S  fwd 

14.5 

8.0 

4.5 

3.8 

14.4 

COMPUTER/ ANALOG  P.S.  (8) 

81.0 

8.0 

8.0 

4.8 

33.6 

VERT.  GYRO  w/BRACKET 

14.0 

13.0 

3.0 

8.0 

6.0 

RATE  GYRO(b) 

13.0 

3.0 

8.5 

3.9 

9.8 

FREE  GYRO  +  MOUNT 

49.0 

8.3 

4.0 

3.3 

13.0 

INVERTER  FOR  D.G. 

47.5 

18.8 

3.0 

1.4 

4.8 

TOPSIDE  THRU-HULLS 

14.0 

8.0 

10.0 

3.0 

30.0 

OS  9  CAGE  (right) 

31.3 

5 . 0 

5.5 

4.8 

88.8 

OS  9  CARDS  (0.4  lb  x>  IS 

31  .3 

5.0 

5.5 

5.4 

89.7 

486  CAGE  (left) 

31.3 

10.0 

5.5 

3.6 

80.1 

486  CARDS  (0.4  lb  x)  3 

31.3 

10.0 

5.5 

1  .4 

7.4 

RIBBON  CABLE  INTERFACE  (4) 

41.0 

7.8 

7.0 

1.5 

10.5 

WIRING,  MISC. 

31.3 

7.8 

8.0 

3.0 

84.0 

TURBO-PROBE  INCL.  MOUNT 

-8.0 

4.0 

4.0 

3.4 

13.6 

DATASONICS  SONAR,  MOUNT,  WIRES 

-4.0 

6.0 

8.5 

8.4 

6.0 

T7S5  SCANNING  SONAR 

-8.0 

10.0 

5.5 

8.6 

14.3 

T1000  PROFILING  SONAR 

-5.0 

10.0 

5.5 

8.6 

14.3 

TRITECH  SONAR  MOUNT,  WIRES 

-7.0 

10.0 

■  w) 

3.0 

16.5 

BUOYANCY,  SONARS 

-6.0 

9.5 

5.5 

-8.0 

-11.0 

BUOYANCY,  SUPP’S,  T-PROBE 

-4.0 

8.0 

5.0 

-0.6 

-3.0 

i7l 

TRIM  LEAD,  by  fr  gyro  inv 

51.0 

18.8 

1.0 

4.5 

4.5 

TRIM  LEAD,  AFT 

63.0 

8.3 

3.0 

5.9 

17.7 

TRIM  LEAD,  aft  of  computer 

38.0 

7.8 

8.5 

7.8 

18.0 

TRIM  LEAD,  by  fr  gyro 

51.0 

4.0 

1.0 

5.0 

5.0 

TRIM  LEAD,  forw  of  computer 

84.5 

6.5 

8.5 

6.1 

15.3 

TRIM  LEAD,  tweak 

38.0 

8.3 

8.0 

0.3 

8.8 

TOTALS 

Ibs-TOT 

388.5 

1651 .8 

B8»CTR“BL»Y2  -  CGz,  INCHES  0.50 

RESERVE  BUOYANCY  (FRESH)  LBS.-est.  0.5 


NOTE:  X  DATUM  IS  FORWARD  OUTER  HULL  EDGE,  POSITIVE  AFT 
Y  DATUM  IS  INNER  STBD  HULL  SIDE,  POSITIVE  TO  PORT 
2  DATUM  IS  INNER  HULL  BOTTOM,  POSITIVE  UP 
CTR-BUOY(in)  X,Y,2  31. E5,  7.75,  4.75 


AmNDRS  fBBCrnOOTNCBMBQABDWlWNGmACW^ 


CofB  Intfeoto  Lo  TnM  PIA  Tam^nol  2t 


Oag0  Conlrol  Lo  Tnio  PIA  TomdM  SO 


ycc^ay 


Unoat*  ConM  Lo  Tnio  PIA  Torminal  48 


(Mlilol  Oraund) 


BQAR0/D6  SYSTEM 


n;T.ChHstkin 


^  wmm  ntifiB  m  mmoi  MMogv 

,^JL  *  nkjl ) 


I 


4mM« 


ski  OfSki  i,ski  2} 

«Mki«  9Mt(S](37*liCS}7bC3Mk(SKrst,q,rirt 


/•  ^(®  1  0}®  ®  it®  ®  ®]i  filiii««sps(s*0.1)i  wksrs  4t  •  O.l  */ 
M®]  •  ®.3l 
Hil  -  9,kt 
M21  -  i.®f 


/*  piiil  «  11.0  0.1  0.005 

0.0  1.0  0.1 

0.0  0.0  1.01  */ 

«lili(0](01  •  1.0; 

9iiii(0)(l]  »  0.1; 

9011(01(21  •  0.005; 

9lill{lH01  •  0.0; 
pOlKlKH  •  1.0; 
phii(l](21  •  0.1; 

9hii(21(01  •  0.0; 
phildldl  •  0.0; 
phii{21(21  •  1.0; 

rv  •  0.1; 

H  •  0.01; 

/*thr«s  «  2.0;  Global  Now  */ 

/*  h  -  (1  0  01;  V 
0(01  •  1.0; 
b(ll  •  0.0; 

0(21  •  0.0; 

if(kal  iait  —  1) 

i 

*sk_0  •  yk; 

♦sk”!  •  0.0; 

*sk”2  •  0.0; 

/*  xkl*sk;  */ 
ski  0  •  •xk  0; 
skl*"l  •  •sk'”l; 
ski***!  •  ♦sk''2; 

I 

/*  sot  Ik  •  coast.  */ 
lk[0]  •  0.2544; 
lk{l]  «  0.3727; 
lk(2]  •  0.2731; 


M9  m  ^iil9H«]*(*sk_0)  ♦  phli(OI(l]*(*xk  1)  ♦  phii(0ir21*(*xk  2)i 
«kQ  •  pkliU]|0)*C*l|-*)  »  pkiidlUlM'sk-l)  *  Litu  I  .  ..k-2 
«kl_J  •  fkll{2](t|*(*«k_0)  ♦  phtlt2Hll*(*sk~l)  ♦  phllI2H2]*(*xk~2)i 

/*  m*(yk(i)-k*xkl(  ipi))i  •/ 

m  •  yk  -  (h(0|*xkl_0  ♦  k(ll*xkl_l  ♦  h(2]*xkl_2); 

/*  t«t  r««  •  0.0  If  l«r9«c  than  tkrxskold  •/ 
if<fxbs(r«s)  >  thr«a) 


0.0; 


/*xk(:pl<»>l)«xkl(}pi)  ♦  lk*r««;  */ 
*xk  0  •  xkl  0  lk(0]*r«i; 

•*k“l  -  xki'l  ♦  lkIX|*r««; 

*xk’“2  -  xkO  ♦  lk(2]*r*s; 


ill  IIATLAB  toorM  cod«»  wiiicli  timalatM  the  AUV 


SHMinwritaf  hi  a  lieriiaBtel  plant  it  pravided  on  the  IbBofiiiiif  pi^iee. 


l 


iia 


9m  itaomxoii  aoDiLt  iiMittivifttMG  xm  ■ckxsomtal  riANt 
cXmci 


MD  99kth  W9m  Ttf  T 
l«a4  McXSMf 
iMd  dlSMi 
t  •  MrlSHf 

h  •  «12Sfi 

ll»  •  XOOf 

dt  -  O.li 

t  •  tOidttdt*lir); 

DBRXV  or  XMMt 

Md)  -  (li(2d)>h(ld))/0.1i 
foe  X  •  2tNr, 

hd(X)  -  (h(I^l,2)-h(I-X,2))/0.2; 

•ftdf 

FIND  SCALI  AND  HAS 
hr  -  h(l:ltP,3)'; 

r  "  poly£it(hr,hd,l ) ; 


XNXT  CONOt 

X8(l) 

0.0; 

YS(1) 

sd,3); 

tt(l) 

0.0; 

V(l) 

0.0; 

r(l) 

hd,3); 

rdot 

0.0; 

Ydotsd) 

0.0; 

Zdotd) 

0.0; 

or 

Pir 

rsxd) 

6r+hd,2); 

POSITION  OKOEAS 

PSXCoa 

■  6r*lS0/pi-0.0; 

XCMI 

»  0.0; 

Te<» 

■  4.0; 

CONTIOL  LAW  GAINS 

nr 

-l.O; 

nr 

1.0; 

S?‘ 

00.0; 

1.0; 

Er 

i^si*Tdr; 

0.0; 

Ex 

Tdx 

3.0; 

Ea 

Sx*Tdx; 

12.0; 

^  3.0; 

Ev  • 

•  Ey*t4^; 

%  for  RVr,  FW,  or  -  pi; 

%  fivo  PSIcoa  in  dogroos 

%  for  KW,  mi  •  -1.0; 

%  for  nr,  nr  •  -1.0; 

%  for  YAN,  LAY  tost,  Kx  •  0.0; 
%  for  YAW,  LONG  tost,  Ky  •  0.0 


MM  ISMMIIIMI 

NHI 

24.01 

mr 

1.01 

tr 

2.01 

m 

U.Slf 

99 

21.0/12.01 

Xf 

0.12S/12.Of 

«• 

2.01 

XU) 

Xh U ) -St •eo« ( rt X U ) ) 1 

TU) 

ytU)-SHMU(ftXU) )  1 

Ydotd) 

TdettU)-st*rd)i 

lYMOiYiiANxc  cotrrti 

XttV 

-1.01 

Xttdot 

-0.00*377.671 

Tw 

-O.S*S1.72; 

Yrr 

0.01107*377.671 

Yvdot 

-0.04*377.671 

Trdot 

-0.00170*2756.01} 

Mw 

-0.00769*377.67} 

Nrr 

-0.04*2756.81} 

HvdOt 

-0.001*2756.01} 

XtsMrdot 

45. 0-(-0. 002*20137. 50) 

for  1  •  1:R?, 

CALCUXATI 

VOI.TA6I8 

VFTHd)  -  -(«p*l*(fSI(I)-f8Ico**pi/10O)4.Kr*r(X) 
♦Ml*  Uy*  ( Y*  ( I  >  -Yco« )  ♦iv*  Ydot  (!)))» 
if  VrTH(I)  >  imv,  VFTHd )  •  NHV;  •ndl 
if  VFTHd)  <  -Mfiv,  VFTHd)  -  -MHV;  vnd; 

VATHd)  ♦  (Kp*i*(FSXd)-FSIco**pi/180)+Kr*rd) . 

-Mf*(Ey*dS(X)-Ycwi)+Kv*Ydot(X) ) ) ; 
if  VATH(X)  >  NHV,  VATH(X)  •  imV;  •nd; 
if  VATH(X)  <  >lfflV,  VATB(X)  •  -NnV;  tnd; 

VX^(X)  -  •F«*(Kx*(XS<X)>Xeo«)^Ku*Xdotd)); 

if  VLS(X)  >  MKV,  VLS(X)  •  miV}  Vfldr 
if  VX^(X)  <  -tm,  VLSd)  •  •tmvt  end; 

vxtd)  «  -nr*(lbi«(Xs(X)-Xeott)^Ku*xdetd))i 
if  VISd)  >  MRV,  VXS(X)  •  miV;  •adf 
if  VltSd)  <  HHIVr  VM(X)  -  -imvf  Hnd; 

CALCOXJiTX  roteti 

rmd)  -  Tr/(IIHV2)*vrTH(X)*«b«(VFTH(X)); 

FATId)  •  Tr/(MRV*2)*VATI(X)*«bs(VATH(X)); 

mid)  •  rm(x)^rATid)i 

md)  •  <rmd)-rATH(x))*0F; 

rud)  -  l•r/(lillv-2)*vt•d)*•b•(VL8(x)); 

rM(X)  •  Hfr/(IIIIV*2)*Vlf(X)*db«(VHS(X) ); 


Of  NOTIOM 

udot  •  (a*v(X)*r(Z)<*-Xuu*u(I)*ftbs(u(Z) ) . . . 

♦rLS  ( Z  )^PM(  Z ) )/( a-Xudet ) ; 

▼dot  -  (Yw*v(Z)*obt(v(z))<*>yrr*r(Z)*abt(r(Z)  )-a*u(Z)*r(Z) . . . 

<*>yrdot*rdet-»>rTTB(  Z ) )/( a-Yvdot ) ; 
rdot  •  (llvdot*vdot<»>Nw*v(Z)*obs( v( z )  )-*>Nrr*r(  Z  )*»b8(  r(  z ) ) . . . 
♦RTK  Z ) )/( ZasNrdet ) $ 

Xdot<Z<*>l)  •  u(Z)*eo8(rtI(Z})-v(Z)*8in(PSZ(Z)); 
ydot(Z4>i)  •  u(z)*tin(r8Z(Z))-*>v(z)*cot(PSZ(z)); 
ydets(Z4>i)  -  ydot(z<fi)<*>xt*r(z); 

%  XULXX  ZMTtOKATZOM 

u(Z^l)  •  u(Z)<»>udot*dt| 
v(Z4>l)  -  v(Z)4>vdot*dt} 

r(Z4-l)  •  r(Z)<»>rdot*dt; 

PSZ(Z4>1)  -  PSZ(Z)<i>r(Z)*dt7 
X(Z<t>l)  •  X(Z)4>Xdot(Z4-l)*dt; 

Y(Z^l)  -  Y{Z)>Ydot{Z-».l)*dt; 

X8(Z>i>l)  •  X(Z4>l)4>xs*cos(PSZ(Z4>l) )  ; 

ys(Z<fl)  -  y(Z<fl)4.xs*sin(PSZ(I<i>l) ) ; 

•nd 


H«iltgr,  A.  Itevo,  D.  Vifille^kiiflflifiMionPlanimif  by 

AnlOiMNMiM  Miiiioii  Dste  Vitnaliiation  tiM  NFS  AUV 

11,”  Pne^edmgt  of  the  IKES  Otmoie  Eiu^iuoring  Society  Sympoeium  on 
AMtonomoue  ImdenooierVtkiekCt  AUV-SSwoMagtaOtB.  1992. 


bifBld,  B.  W.,  ”Kiiy  PMstavt  idboliftestioiiflniBk  Inuift  Pfeofil^StfiiMiits 
Higii  Frtmacy  Sonar,"  Maotor't  Tboaia,  Narral  Pootgraduato  School, 
Moataiiy,  Gidiiiniia,  DoombIw 


Miarco,  p.  B.,  Doctoral  Diioortotion,  Naoid  Pootpadvato  School,  Montoroy, 
^3i9Stmla,  Itrthcoaidng. 


Sanadm,  T.  B.,  "Pcrferauaico  of  SinaB  Thruotan  and  PCopiiloioa  Syatoau," 
Ifaalar'a  Thaoia,  Naval  Paolgrateala  School,  Ifantoray,  Cahfbniia,  March 
19B9. 


Wacaar,  D.  C.,  "Doahp,  Wainlatian  and  Bapariawntal  Vorillcatlon  of  a 
CaqpatifMc^  AUV  y 


AknaArte.  VA  S1S0M146 


A  Ubnqr.Godifil 


I  V  .  i  /  P  n  ’ .  _ '  *  { 


'.CAMMS^OOa 


Moiitifv.  CA  98M3-6000 


4.  Dr.AiillMiVJ.HMlv.GQdAlfEm^ 


;GA98M3-6000 


MoaUnr,  CA  98943^1000 


6.  Dinrid  P.  IhiiUaMM,  LCra»  IWN,  Code  OR/Mt 


;CA  98943-3000 


7.  Mr. 


;  N«rM  fiqplorivv  OrdbuBCt 


ladtan  H«A  MD  908403070 


«.  CaMfflMN.Cainttio,CUa>T.inN(Stt).Cod»M^^ 


1 


DtpWtflMBft  of liaelyBliClll  fBnjina*fj|||r 

iwtW  FOTipranosM  omuoi 
Momwogr,  GA  93943-6000 

9.  WateA.BrieMii»CAFT.USN(R«t)  1 

9900  Cwmmino  PUco 

SMiDiofo^CA  93131 

10.  RMiiaidB.P4tfMdl.CAPT,l^  1 

1228  Sothdlqf  Court 

Virfiiiia  BomIi.  VA  23464 

11.  DU¥idE.WoodlMiiy,  GAFT,  USN  (Rot)  1 

7126  Rod  Horoo  Tovom  Lono 

S|priiiffiold,VA  22153 

12.  KovmA.lMollo,LT,USN  1 

Oporotiona  D^MrtiiiMit,  Godo  8()0 

Norfolk  Naval  Shipyard 
Plortamooth,  VA  23709-5000 


